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The  Rotating  Unbalanced  Mass  (RUM)  device  was  originally  developed  at 
NASA’s  Marshall  Space  Flight  Center  by  Dr.  Michael  Polites  to  provide  an  efficient, 
accurate  means  of  scanning  space/balloon-bome  gamma  ray  and  x-ray  telescopes. 
The  special  optics  in  a  gamma  ray  or  x-ray  telescope  only  allow  for  physical  scanning 
of  the  telescope  to  image  the  radiation  source.  Physical  scanning  requires  that  the 
entire  telescope  be  moved  in  a  manner  to  generate  the  particular  patterns  required  to 
image  the  radiation  source.  Employing  the  RUM  device  on  a  space  or  balloon-borne 
system  reduces  the  complexity  and  power  requirements  compared  to  standard 
scanning  actuators  such  as  control  moment  gyros  (CMG),  reaction  wheels,  or  torque 
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motors.  To  further  enhance  the  benefits  of  utilizing  the  RUM  device,  pointing 
actuation  is  currently  being  researched. 

This  dissertation  focuses  on  the  development  of  a  complete  model  of  the  RUM 
actuated  system  and  on  the  feasibility  study  of  RUM  actuated  pointing.  This  research 
effort  involves  extensive  modeling  using  a  robotics  approach  known  as  the  Lagrange 
Formulation.  Applying  well-developed  robotic  kinematic  and  kinetic  concepts  to  this 
problem  provides  a  systematic  approach  to  system  modeling  and  identifies  how 
individual  components  of  the  system  interact.  The  RUM  actuated  system,  however,  is 
unique  in  a  robotics  sense  because  of  its  configuration  and  actuation.  Therefore,  the 
Lagrange  Formulation  must  be  modified  when  applying  it  to  the  RUM  system.  This 
detailed  modeling  approach  reveals  previously  unmodeled  inertia,  centripetal,  and 
Coriolis  terms  in  the  equations  of  motion  for  the  RUM  actuated  system.  Obtaining  this 
complete  model  facilitates  detailed  control  analysis,  which  helps  determine  the 
feasibility  of  pointing  actuation  using  the  RUM  device.  This  analysis  draws  from  non¬ 
linear  reachability  conditions  and  the  dynamic  coupling  index.  These  discoveries  give 
considerable  insight  into  control  schemes  and  computer  simulations  confirm  that 
pointing  actuation  may  be  possible  using  the  RUM  device.  An  additional  control 
scheme,  which  cancels  undesirable  dynamic  components  including  certain  inertia, 
centripetal  and  coriolis  terms,  is  necessary  along  with  possible  configuration  changes. 
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CHAPTER  1 


INTRODUCTION 


Remote  sensing  of  gamma  ray  and  x-ray  sources  poses  unique  attitude  control 
challenges  for  balloon  or  space  borne  telescopes.  The  challenges  include  pointing  and 
scanning  of  the  telescope  optical  systems.  Pointing  is  two  dimensional  motion  that 
turns  the  telescope  in  a  given  direction  for  target  acquisition  and  centering  a  scan  on 
the  target.  Figure  1  shows  an  example  of  a  ground  based  telescope  in  pointing  motion. 


Figure  1  Telescope  Pointing  Motions 


1 


2 


Scanning  is  small,  localized  two  dimensional  motion  accomplished  by  electronically 
or  physically  changing  or  moving  the  optics  of  the  sensor.  Figure  2  shows  an  example 
of  a  ground  based  telescope  in  physical  scanning  motion. 


scanning 

motion 


The  special  optics  in  a  gamma  ray  or  x-ray  telescope  only  allow  for  physical 
scanning  of  the  telescope  to  image  the  radiation  source.  Physical  scanning  requires 
that  the  entire  telescope  be  moved  in  a  manner  to  generate  the  particular  patterns 
required  to  image  the  radiation  source.  An  innovative  new  type  of  actuator  called  the 
rotating  unbalanced  mass  (RUM)  device  was  recently  developed  at  NASA  (National 
Aeronautics  and  Space  Administration)  by  Dr.  Michael  Polites  [1,2]  to  accomplish  the 
scanning  requirements  of  these  optical  systems.  The  RUM  has  proven  to  provide  an 
efficient,  accurate  means  of  scanning  space/balloon-borne  gamma  ray  and  x-ray 
telescopes  during  ground  testing  [3].  Employing  the  RUM  device  on  a  space  or 
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balloon-borne  system  reduces  the  complexity  and  power  requirements  compared  to 
standard  scanning  actuators  such  as  control  moment  gyros  (CMG),  reaction  wheels,  or 
torque  motors.  The  next  challenge  is  to  use  the  device  to  accomplish  the  pointing 
necessary  for  target  acquisition  and  proper  imaging.  If  the  RUM  device  proves  to  be  as 
effective  at  pointing  actuation  as  it  has  been  at  scanning  actuation,  considerable 
actuator  hardware  reductions  are  possible. 

1.1  Problem  Statement 

Attitude  control  for  balloon  and  space-borne  gamma  ray  and  x-ray  telescopes 
is  divided  into  two  areas:  scanning  and  pointing.  Currently,  the  telescope  is  pointed 
using  an  auxiliary  control  system  (ACS)  consisting  of  the  standard  CMG’s,  reaction 
wheels  or  torque  motors  and  scanning  is  accomplished  using  the  RUM  actuator.  The 
research  conducted  for  this  dissertation  is  motivated  by  the  prospect  of  simplifying  or 
eliminating  the  ACS  by  using  a  pointing  control  scheme  incorporating  RUM  devices 
for  pointing  actuation. 

1.2  Problem  Approach 

Since  linearized  scanning  models  of  the  RUM  actuated  systems  appear  to  be 
inaccurate  for  pointing  control,  a  systems  approach  to  modeling  and  control  is 
incorporated  that  draws  from  dynamic  modeling  of  robots  using  the  Lagrange 
Formulation.  Applying  well-developed  robotic  kinematic  and  kinetic  concepts  to  this 
problem  provides  a  systematic  approach  to  system  modeling  and  identifies  how 
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individual  components  of  the  system  interact.  The  RUM  actuated  system,  however,  is 
unique  in  a  robotics  sense  because  of  its  configuration  and  actuation.  Therefore,  the 
Lagrange  Formulation  must  be  modified  when  applying  it  to  the  RUM  system.  This 
unique  approach  provides  equations  of  motion  that  give  the  designer  physical  insight 
into  the  behavior  of  the  overall  system  and  is  critical  in  the  development  of  pointing 
control  schemes. 

1.3  Dissertation  Overview 

This  dissertation  describes  the  approach  used  to  analyze  pointing  control  using 
the  RUM  device.  This  research  focuses  on  the  development  of  a  complete  model  of 
the  RUM  actuated  system  and  on  the  feasibility  study  of  RUM  actuated  pointing.  The 
dissertation  is  divided  into  the  following  chapters:  Chapter  2  presents  background 
information  on  the  special  scanning  requirements  of  gamma  ray  and  x-ray  optics  and 
how  this  scanning  is  accomplished  using  the  RUM  device.  This  chapter  also  presents 
previous  work  on  pointing  control  using  the  RUM  device.  Chapter  3  introduces 
robotic  modeling  concepts  that  are  used  in  Chapter  4  for  the  development  of  the  RUM 
equations  of  motion;  e  g.  Denavit-Hartenberg  (DH)  convention  and  Lagrange 
Formulation.  Chapter  4  covers  RUM  system  kinematic  modeling  based  on  the  DH 
convention  and  RUM  system  dynamic  modeling  based  on  the  Lagrange  Formulation. 
It  covers,  in  detail,  the  modifications  necessary  when  applying  these  robotic  modeling 
techniques  to  the  RUM  actuated  system.  Since  this  modeling  approach  is  unique  in  a 
robotics  sense,  the  dynamic  model  is  validated  in  Chapter  5.  Chapter  6  examines  the 
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feasibility  of  RUM  actuated  pointing  control  by  investigating  several  control 
approaches  that  might  achieve  pointing  control.  This  chapter  addresses  the  nonlinear 
control  aspects  of  the  system  and  points  out  control  considerations  for  RUM  actuated 
systems.  Chapter  7,  the  concluding  chapter,  presents  a  summary  of  research 
discoveries  and  suggestions  for  future  work  in  numerous  areas  related  to  the  RUM 
analysis. 


CHAPTER  2 


BACKGROUND  INFORMATION 


The  RUM  device  was  originally  developed  to  provide  an  efficient  means  of 
scanning  space  and  balloon  borne  telescopes.  This  chapter  provides  background 
information  on  the  unique  requirements  of  gamma  ray  and  x-ray  detectors  and  how 
they  influenced  the  development  of  the  RUM  device.  Next,  it  presents  an  overview  of 
RUM  actuator  concepts  when  used  for  scanning  purposes.  Finally,  prior  work 
accomplished  toward  pointing  control  is  discussed  along  with  the  necessary  technical 
study  involving  modeling  and  control  issues. 

2.1  Optical  Requirements  for  Gamma  Ray  and  X-ray 

This  section  presents  the  needs  of  the  user  based  on  optical  requirements  of 
this  special  remote  sensing  equipment. 

2.1.1  Space  and  Balloon-Borne  Systems 

Gamma  ray  and  X-ray  detectors  require  a  balloon-borne  or  space  borne 
platform  for  several  reasons  [4]: 

1 .  Atmospheric  absorption  prevents  much  of  the  radiation  from  ever  reaching  ground 
based  telescopes.  Figure  3  depicts  the  electromagnetic  (EM)  frequencies  reaching 
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the  surface  of  the  Earth  and  those  absorbed  or  blocked  by  the  atmosphere.  X-ray 
and  gamma  ray  radiation  is  blocked  at  rather  high  altitudes  (approximately  25  to 
30  thousand  feet)  making  it  very  difficult  if  not  impossible  to  detect  these  radiation 
sources  from  ground  based  sensors.  In  order  to  detect  gamma  ray  or  X-ray  sources 
accurately,  the  imaging  system  must  be  above  the  level  of  the  atmosphere  that  is 
distorting  and  blocking  the  radiation. 

2.  Images  of  astronomical  objects  are  blurred  when  light  travels  through  the  turbulent 
and  clumpy  air  around  the  Earth. 

3.  Ground  based  telescopes  receive  stray  light  interference  from  cities  and  from 
atmospheric  auroras. 

4.  Angular  resolution  is  dramatically  increased  when  using  space  based  optical 
telescopes.  Space  telescopes  can  generally  distinguish  details  separated  in  angle 
ten  times  better  than  ground  based  systems. 


5  0-2-4  -5  -6  -9  -13 

X  ►  (where:  wavelength  =  (10^  cm)) 

Figure  3  Atmospheric  Blocking  of  EM  Radiation  [  4] 
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2.1.2  Special  Optics 

Gamma  rays  and  X-rays  penetrate  the  normal  'mirror'  optics  of  standard 
telescopes  without  being  detected.  Gamma  ray  detectors  require  unique  hardware  such 
as  used  in  the  spark  detector  shown  in  Figure  4.  Gamma  ray  detectors  track  the 
gamma-ray  photon  as  it  passes  close  to  the  nucleus  of  an  atom  in  the  target.  The 
photon  disappears  and  a  pair  of  electrons  take  its  place.  The  electrons  absorb  the 
photon’s  energy  and  retain  much  of  its  trajectory  leaving  trails  of  ions  in  the  detector. 


Figure  4  Spark  Chamber  Gamma  Ray  Detector  [  4] 

Similarly,  the  X-ray  detector  requires  special  optics  such  as  the  grazing  incidence 
telescope  shown  in  Figure  5.  It  uses  highly  polished  glass  tubes  to  direct  the  X-ray 
radiation  by  placing  them  at  high  incidence  angles  to  the  source.  Applying  Snell’s 
Law  to  gamma-ray  and  X-ray  radiation  provides  the  incidence  angles  needed  for 
proper  focusing  of  the  image. 
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Figure  5  Grazing  Incidence  X-Ray  Detector  [  4] 


2.1.3  Scanning 

The  special  optics  and  the  sources  to  be  detected  present  some  unique  control 
requirements  for  the  imaging  process.  First,  the  limited  field  of  view  (FOV)  requires 
that  the  imaging  device  be  scanned  to  give  proper  dimension  to  the  image  [5], 
Referring  to  Figure  6,  a  simple  example  of  electro-optical  scanning  would  include  a 
one  dimensional  scan  of  an  object  orthogonal  to  the  flight  path  of  an  aircraft.  The 
motion  of  the  aircraft  generates  the  second  dimension  of  the  image  and  is  an  example 
of  physical  scanning. 


Figure  6  Scanning  Example 


Second,  since  gamma  ray  and  X-ray  radiation  is  always  present  as  background 
radiation,  it  is  necessary  to  distinguish  between  background  radiation  and  source 
radiation  when  imaging  a  gamma  ray  or  X-ray  source.  Scanning  “on  target”  and  “off 
target”  identifies  the  flux  coming  from  the  background  so  it  can  be  compared  to  that 
coming  from  the  source  [6],  Typical  scanning  patterns  include  linear,  circular,  and 
raster  scanning  as  depicted  in  Figure  7  [5,6,1],  Gamma  ray  and  X-ray  detectors 
generally  require  adjustable  scan  periods  and  radii  to  meet  user  needs. 


linear 


raster 


Figure  7  Typical  Scanning  Patterns 
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2.1.4  Traditional  Scanning  Methods 

The  special  make-up  of  gamma  ray  and  X-ray  detectors  prevent  them  from 
being  electro-optically  scanned.  Physical  scanning  is  the  only  option  for  these 
detectors.  Prior  scanning  techniques  incorporated  torque  motors,  reaction  wheels, 
control  moment  gyros  or  reaction  control  devices  to  generate  the  desired  scan  patterns. 
A  detailed  description  of  these  components  is  covered  in  Reference  [7].  Basic 
operation  and  advantages/disadvantages  of  each  are  described  as  follows: 

1 .  Momentum  control  devices  actively  vary  the  angular  momentum  of  small  masses 
within  the  spacecraft  to  change  attitude.  Reaction  wheels  and  control  moment 
gyros  are  momentum  control  devices.  Reaction  wheels  vary  spin  speed  to  effect  a 
change  in  the  angular  momentum.  They  provide  highly  accurate,  fast  response 
attitude  control.  They  are  complex  and  expensive,  however,  and  have  a  large 
power  consumption  in  the  scanning  mode  of  operation.  Control  moment  gyros 
(CMG)  vary  spin  direction  to  effect  a  change  in  angular  momentum.  The 
advantages  and  disadvantages  are  similar  to  reaction  wheels. 

2.  Reaction  control  devices  are  basically  jet  thrusters.  The  thrusters  apply  a  force  at  a 
distance  from  the  center  of  mass  (CM)  to  effect  a  torque  about  the  CM.  They  can 
produce  fast  responses  but  have  limited  use  since  they  require  propellant,  which  is 
exhaustible.  Because  of  their  nonlinear  ‘on-ofF  behavior,  they  are  difficult  to 
control  and  very  inefficient  for  scanning  use  since  excessive  propellant  is  required. 
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3.  Torque  motors  provide  the  simplest  means  of  attitude  control.  Electronic  motors 
apply  torque  to  a  gimbaled  system  by  ‘pushing’  against  the  gimbal  platform.  The 
‘pushing’,  however,  can  cause  instability  for  balloon-borne  gondola  systems  [8]. 
Torque  motors  require  excessive  power  during  scanning  operation  and  they  cannot 
be  used  for  free  flying  spacecraft  because  there  is  no  platform  to  ‘push’  against  [1]. 

2.2  The  RUM  Device 

All  of  the  traditional  methods  of  scanning  have  serious  drawbacks  including 
excessive  weight,  cost,  and  limited  lifetime.  The  primary  motivation  for  developing 
the  RUM  device  was  reducing  payload  mission  requirements.  Major  factors 
influencing  space  and  balloon-borne  payloads  are  efficiency,  low  cost,  and  reliability; 
the  RUM  device  was  developed  to  meet  all  these  requirements.  Simulation  and 
prototype  test  results  have  shown  that  the  RUM  device  has  a  great  advantage  over 
reaction  wheels  and  torque  motors  in  the  areas  of  weight  and  power  consumption 
[1,3].  This  section  presents  a  brief  overview  of  the  RUM  concepts.  References  [1] 
and  [3]  provide  excellent  explanations  of  the  RUM  device. 

2.2.1  Basic  Concept 

The  concept  of  scanning  using  rotating  unbalanced  masses  is  a  geometry  and 
physics  problem  involving  the  mechanical  properties  of  the  system.  The  RUM  device 
consists  of  a  mass  on  a  lever  arm  rotating  at  a  constant  angular  velocity.  The  mass 


rotation  generates  a  centripetal  force  that  has  constant  magnitude  but  changing 
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direction.  This  force  applied  through  a  distance  from  the  center  of  mass  generates  a 
torque  about  the  center  of  mass  that  also  has  time  varying  direction.  The  time  varying 
torque  produces  the  necessary  scan  motion,  which  can  be  circular,  linear,  or  raster 
depending  on  the  configuration  of  the  RUM  devices  [1].  In  developing  this  concept, 
several  assumptions  were  made: 

1 .  The  center  of  mass  is  along  the  line  of  sight. 

2.  The  line  of  sight  is  the  axis  of  minimum  principal  moment  of  inertia  (Imin)- 

3.  The  other  two  principal  moments  of  inertia  are  equal  (Imax). 

4.  Localized  RUM  motion  (i.e.  small  angle  of  movement  of  the  experiment). 

5.  Constant  RUM  velocity  (constant  cor). 

6.  The  RUM  device  is  treated  as  a  simple  actuator  decoupled  from  the  experiment 
dynamics  except  as  an  input  to  the  system. 

Note:  Assumptions  7  and  8  specifically  apply  to  only  balloon-borne  systems. 

7.  The  Experiment  is  attached  to  the  gondola  by  a  2  axis  gimbal  system. 

8.  Balloon  rotations  are  isolated  from  the  experiment  by  a  separate  azimuth  control 
system. 

Based  on  these  assumptions,  a  linearized  equation  of  motion  for  the  balloon-borne 
gondola  system  is  developed  in  the  next  section. 

2.2.2  Equations  of  Motion 

For  the  balloon-borne  gondola  system  configured  with  a  RUM  device  as 
depicted  in  Figure  8,  torque  about  the  center  of  mass  (CM)  of  the  experiment  is  given 


14 


by  Equation  (1)  [1],  The  masses  are  180®  spatially  displaced  from  each  other  and 
rotate  in  the  same  direction. 


Figure  8  Balloon-Borne  Experiment  in  a  Circular  Scan 


fr  1 

^LOS 

0 

T 

=  2mo)\rd 

-sin(0^) 

T 

L  ^  J 

+cos(0«) 

where: 

T(los,e,x)  =  torque  about  the  line  of  sight  (LOS),  elevation  (E),  or  cross-elevation  (X) 
axis  respectively  (ft-lbs), 
m  =  mass  on  end  of  lever  arm  of  RUM  (slugs), 
r  =  length  of  lever  arm  (feet). 
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d  =  distance  from  CM  to  attachment  point  of  RUM  (feet), 

®R  =  angular  velocity  of  rotating  mass  (radians/sec), 

0R  =  (Or  •  t  =  angular  position  of  rotating  mass  (radians). 

Using  these  torques  in  the  linearized  equation  of  motion  given  by  Equation  (2)  and 
integrating  twice  gives  the  steady  state  scan  motion  given  by  Equation  (3). 


^LOS 

0 

0  ' 

fr  1 

^LOS 

0 

max 

0 

T 

1 - 

0 

0 

/■? 

^  min^ 

1 - 

1 _ 

(2) 


where;  9^^=  angular  acceleration  about  the  respective  axis  (rad/sec^)  and  /  =  the 
payload  moment  of  inertia  (slug-ft^). 
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where:  0(e,x)  =  angular  rotation  about  the  elevation  and  cross-elevation  axis  (rad).  This 
results  in  the  circular  scanning  motion  depicted  in  Figure  7.  The  radius  of  the  scan  is 
given  by  Equation  (4)  and  the  period  of  the  scan  is  given  by  Equation  (5).  Note  that 
the  radius  and  period  of  the  scan  are  independent  of  each  other.  This  is  a  valuable 
design  benefit,  making  it  possible  to  adjust  the  period  of  the  scan  without  changing  the 
radius  of  the  scan  and  change  the  radius  without  changing  the  period. 

Imrd 
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For  the  balloon-borne  experiment  configured  as  depicted  in  Figure  9,  torque  about  the 
center  of  mass  of  the  experiment  is  given  by  Equation  (6)  and  results  in  the  steady 
state  scan  motion  given  by  Equation  (7)  resulting  in  the  linear  scan  motion  depicted  in 
Figure  7. 


Figure  9  Balloon-borne  experiment  in  a  linear  scan 
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The  raster  scan  is  generated  by  using  the  linear  scan  configuration  and  superimposing 
complementary  motion  from  an  auxiliary  control  system  (ACS)  that  will  be  described 
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in  the  next  section.  The  development  is  similar  for  the  free  flying  spacecraft  and  the 
gimbaled  space  platform  experiment.  See  Reference  [1]  or  [3]  for  details. 

2.2.3  Auxiliary  Control  System 

An  auxiliary  control  system  is  needed  to  supplement  the  RUM  devices  and  is 
usually  made  of  traditional  control  devices  such  as  reaction  wheels,  torque  motors,  etc. 
The  auxiliary  control  system  is  used  for  the  following  pointing  and  scanning  purposes: 

1.  Target  acquisition. 

2.  Keeping  the  center-of-scan  on  target. 

3.  Producing  the  complementary  motion  for  raster  scanning. 

Figure  10  shows  the  test  configuration  of  the  gimbaled  system  using  torque  motors  for 
the  ACS,  The  elevation  and  cross-elevation  axis  are  controlled  independently  with 
low  frequency/low  amplitude  torques  where  as  the  RUM  devices  are  controlled  by 
high  frequency/high  amplitude  torques  [1].  Low  pass  filtering  keeps  the  ACS  from 
fighting  the  motion  generated  by  the  RUM  devices. 
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Figure  10  Test  Configuration 


2.3  Prior  Work  on  Pointing  Control 

It  has  been  suggested  by  Dr.  Polites  that  the  RUM  device  can  be  used  for  not 
only  scanning  motion  but  also  to  control  pointing  motion.  The  research  work 
conducted  through  the  NASA/ASEE  Summer  Faculty  Fellowship  Program  during  the 
summer  of  1996  produced  promising  results  in  the  area  of  RUM  actuated  pointing 
control  [9].  The  goals  of  the  research  program  included  further  dynamical  analysis  of 
the  experimental  system  and  development  of  microcontroller  code  to  achieve  pointing 
control.  The  following  two  sections  cover  dynamical  analysis  and  control  analysis  of 
the  RUM  actuated  pointing  system. 
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2.3.1  Dynamical  Analysis 

The  dynamical  analysis  centers  around  the  basic  concept  that  a  time  varying 
RUM  velocity  (or)  will  produce  a  centripetal  force  having  both  time  varying 
magnitude  and  direction  [2,9],  This  force  can  generate  a  torque  about  the  center  of 
mass  that  also  has  time  varying  magnitude  and  direction.  Figure  11  shows  a 
comparison  between  a  constant  cor  torque  profile  and  a  time  varying  or  torque  profile. 
Note  that  a  net  torque  can  be  generated,  depending  on  how  the  RUM  velocity  is 
varied,  which  in  turn  can  generate  the  necessary  pointing  motion. 


Figure  11  Torque  Profile  about  the  Center  of  Mass 

The  gimbal  mounted  experiment  is  configured  in  the  circular  scan  mode  to  ensure  both 
the  elevation  axis  and  cross-elevation  axis  have  ‘steering’  opportunities.  In  other 
words,  for  the  circular  scan  configuration,  RUM  rotation  generates  torques  about  both 
the  elevation  and  cross  elevation  axis  as  compared  to  the  linear  scan  configuration 
where  torque  is  generated  about  only  one  axis.  Dynamical  analysis  starts  with 


20 


Equation  (8)  which  represents  the  equations  of  motion  for  constant  RUM  angular 
velocity  resulting  from  combining  Equations  (1)  and  (2),  Assuming  reaction  forces 
from  the  acceleration  of  the  RUM  masses  are  small,  pointing  control  will  be  achieved 
by  varying  RUM  angular  velocity,  (or),  in  Equation  (8). 


■X  Idmr  .  fa  \  2 
■A  Idmr  ..  .  2 

dx  =— - COS(02j)®;j 


(8) 


Equation  (8)  yields  some  interesting  observations  [9]: 

1.  The  elevation  and  cross-elevation  angle  dynamics  are  functions  of  RUM  position 
(9r)  and  velocity  (or). 

2.  The  control  input,  cor  ,  varies  based  on  the  position  of  the  RUM  (i.e.  is  weighted 
by  sin(0R)  and  cos(0r)  for  elevation  and  cross-elevation  respectively). 

3.  The  control  input,  (Dr  ,  enters  the  equation  of  motion  as  a  squared  term.  Negative 
Or  has  the  same  effect  as  positive  or  and  must  rely  on  the  sign  changes  of  cosine 
and  sine  factors  to  effect  positive  and  negative  accelerations, 

These  observations  are  used  in  the  next  section  to  develop  the  control  input  necessary 

for  pointing  motion. 
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2.3.2  Control  Analysis 

Dr.  Polites  originally  proposed  to  use  a  control  signal  that  introduces  periodic 
variations  in  the  RUM  rate  wr.  The  basic  approach  for  determining  the  control  input 
is  to  start  with  a  nominal  RUM  velocity  and  vary  it  slightly  about  each  axis.  The 
nominal  velocity  will  provide  the  scanning  motion  necessary  while  the  rate  variation 
will  provide  the  change  in  the  net  torque  necessary  for  pointing  motion.  The  control 
input  is  defined  in  Equation  (9)  as: 

+  A(0^  cos(  )  -  A©^  sin  ( 0^ )  (9) 

where: 

©,o  =  a  constant  (nominal  RUM  rate  of  rotation), 

A© X  =  ^  rate  variation  to  compensate  for  cross-  elevation  gimbal  error , 

A©£.  =  a  rate  variation  to  compensate  for  elevation  gimbal  error . 

Since  the  control  input  is  based  on  the  position  of  the  RUM,  the  rate  variations  must 

be  ‘timed’  properly  to  effect  the  desired  input.  The  sine  and  cosine  terms  in  Equation 

(9)  weight  the  rate  variations  to  give  them  the  proper  ‘timing’.  Substituting  the  control 

input  into  the  dynamical  model  of  Equation  (8)  and  eliminating  small  higher  order 

terms  results  in  the  elevation  and  cross-elevation  axis  acceleration  approximations  in 

Equation  (10). 
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There  are  several  interesting  observations  made  from  this  analysis: 

1 .  The  first  sinusoidal  terms  cause  the  periodic  ‘scanning’  motion  of  the  main  body. 

2.  The  second  terms  affect  the  ‘pointing’  motion. 

Therefore,  pointing  control  can  be  accomplished  by  introducing  periodic  RUM  rate 
variations  Awx  and  Aoe  for  cross-elevation  and  elevation  axis  errors,  respectively, 
without  interfering  with  the  scanning  motion  controlled  by  ©ro-  The  control  developed 
around  this  model  required  a  pointing  controller  and  a  RUM  speed  controller  as  shown 
in  Figure  12.  Note  that  this  is  the  control  system  for  a  single  RUM  device.  Control 
for  the  second  RUM  device  is  identical  with  the  exception  that  the  second  RUM  is 
180°  spatially  displaced  from  the  first  RUM. 
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Figure  12  Control  System  Overview 

The  pointing  controller  uses  a  proportional  derivative  control  design  (PD)  to  provide 
gimbal  control  via  coupling  to  the  RUM  speed  controller  which  uses  proportional  - 
integral  -  derivative  (PID)  control.  The  elevation  and  cross  elevation  torque  motors 
are  disabled  leaving  the  RUM  devices  for  actuation  of  pointing  and  scanning  motion. 
The  test  results  are  shown  in  Figure  13  for  a  small  impulse  disturbance  input  in  the 
elevation  axis. 
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Figure  13  Elevation  Axis  Disturbance  Response 


Pointing  control  test  result  observations: 

1 .  Scanning  motion  is  shown  as  high  frequency  oscillation  on  the  plots. 

2.  Without  pointing  control,  the  system  has  no  disturbance  rejection. 

3.  With  pointing  control  off,  the  system  demonstrates  a  non-linear  behavior  even 
before  it  turns  over  90°.  A  linear  system  would  have  displayed  a  ramp-type 
response  to  an  impulse  input  instead  of  the  exponential  type  response  shown.  This 
seems  to  indicate  there  is  some  coupling  between  the  RUM  dynamics  and  the 
motion  of  the  experiment  beyond  simple  scanning  or  pointing  movement. 

4.  There  is  a  large  steady  state  error  (approximately  10°)  with  pointing  control  on. 

5.  Test  2,  in  Figure  13,  shows  the  best  result  obtained  from  the  pointing  control  test 
and  was  difficult  to  duplicate. 

6.  Further  testing  indicated  there  was  a  small  stability  margin. 
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2.4  Necessary  Technical  Study 

Work  accomplished  in  the  summer  of  1996  indicates  that  pointing  control  may 
be  possible  using  the  RUM  device  as  an  actuator.  There  are  several  open  issues  that 
arise,  however,  when  incorporating  the  RUM  device  and  a  RUM  control  algorithm  to 
accomplish  the  pointing  control.  The  issues  are  divided  into  two  primary  areas: 
Modeling  issues  and  control  issues.  These  issues  are  briefly  introduced  in  the  next 
two  sections  with  detailed  treatment  presented  in  subsequent  chapters. 


2.4.1  Modeling  Issues 

The  modeling  approach  taken  thus  far  has  been  to  use  the  RUM  device  as  an 
actuator  basically  independent  of  plant  dynamics.  The  dynamic  model  developed 
previously  used  the  RUM  device  as  strictly  a  torque  input.  This  was  a  valid  approach 
when  the  small  angle  and  constant  (o  assumptions  were  valid.  A  different  modeling 
approach  may  be  necessary  if  these  assumptions  are  not  valid.  Time  varying  cor 
generates  additional  reaction  force  terms  in  the  modeling  of  the  RUM  device  that  are 
neglected  in  the  original  dynamical  analysis.  A  more  accurate  model  should  include 
these  terms  as  shown  in  Equation  (11). 
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where: 

u  =  torque  applied  to  the  RUM  (control  input) 

J  =  moment  of  inertia  of  the  RUM 
u 

—  = 

J 

Even  this  model,  however,  may  not  be  completely  accurate.  Coupling  between  the 
system  dynamics  and  the  RUM  dynamics  would  invalidate  previous  systems  models. 
A  systems  approach  to  modeling  should  be  used  in  order  to  account  for  the  possible 
coupling  of  the  RUM  device  to  the  experiment  dynamics.  Robotics  provides  a  large 
body  of  knowledge  that  may  be  applicable  to  the  proposed  model.  The  physical 
makeup  of  the  plant  and  RUM  devices  as  seen  in  Figure  10  resembles  the  make-up  of 
robotic  mechanisms.  Using  a  robotics  approach  will  allow  for  the  mechanics  of  the 
problem  by  addressing  how  individual  components  of  the  system  interact.  Applying 
well-developed  robotic  kinematics  and  kinetics  concepts  to  this  problem  provides  a 
systematic  approach  to  system  modeling.  The  Lagrange  Formulation  [10]  is  an 
important  modeling  technique  that  appears  to  be  applicable.  The  RUM  actuated 
system  is  unique  in  a  robotic  sense,  however,  requiring  modifications  to  the  Lagrange 
Formulation. 

2.4.2  Control  Issues 

The  technical  study  must  address  several  control  issues  that  result  from  the 
development  of  equations  of  motion  for  a  time  varying  RUM  velocity.  Even  though 
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Equation  (11)  may  not  be  completely  accurate,  it  brings  up  the  following  control 
issues: 

1 .  RUM  control  actuation  is  unique  in  a  robotics  sense.  Robots  generally  use  torques 
at  the  base  and  subsequent  joints  to  generate  motion  at  the  end  effector.  In  the 
RUM  actuated  system,  the  actuator  is  at  an  end  effector  equivalent  and  is  used  to 
generate  motion  about  the  base  (or  center  of  mass).  Also,  the  RUM  actuator  is 
relying  on  centripetal  force  to  generate  torques  that  cause  movement  at  the  center 
of  mass  of  the  experiment  instead  of  using  directly  applied  torques. 

2.  A  nonlinear  system  model  and  large  angular  motion  require  a  different  control 
method.  Well-developed  robotic  control  methods  involving  feedback 
linearization,  adaptive  control,  or  nonlinear  trajectory  control  appear  to  be  more 
appropriate  than  linear  control  methods  [10,1 1,12,13]. 

3.  The  system  displays  “periodic  controllability”  [14].  Periodic  controllability  is  a 
term  used  to  indicate  the  periodic  nature  of  the  control  signal.  The  RUM  device 
generates  the  sine  and  cosine  terms  in  the  centripetal  and  reaction  components  of 
Equation  (11).  These  terms  have  a  periodic  effect  on  the  “steering”  opportunities 
for  each  axis. 

2.5  Conclusions 

This  chapter  presents  a  brief  summary  of  the  RUM  development  and 
preliminary  research  in  the  area  of  RUM  actuated  pointing  control.  The  basic  concept 
employed  uses  a  time  varying  RUM  velocity  that  produces  torques  about  the  center  of 
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mass  of  the  experiment  having  time  varying  magnitude  and  direction.  These  torques, 
in  turn,  effect  pointing  motion.  Experimental  testing  indicates  that  pointing  control 
may  be  possible  but  considerable  research  is  necessary.  The  technical  study  must 
address  several  issues  to  improve  pointing  performance  of  the  RUM  actuated  system. 
Modeling  and  control  issues  indicate  a  systems  approach  is  necessary  to  account  for 
“periodic  controllability”  and  possible  coupling  of  the  RUM  device  to  experiment 
dynamics.  Chapters  3, 4  and  5  treat  the  modeling  issues  in  detail  and  Chapter  6  treats 
the  control  issues. 


CHAPTER  3 


SYSTEMS  APPROACH  TO  MODELING 

The  modeling  approach  presented  in  References  [1]  and  described  in  Chapter  2 
treats  the  RUM  device  as  an  actuator  that  operates  independent  of  plant  dynamics. 
The  dynamic  model  developed  in  Chapter  2  treats  the  RUM  device  as  strictly  a  torque 
producing  device.  This  is  a  valid  approach  when  the  small  angle  and  constant  to 
assumptions  are  satisfied.  A  different  modeling  approach  is  necessary  if  these 
assumptions  are  not  valid,  as  in  a  pointing  control  application.  Equations  (1)  through 
(7)  are  developed  under  the  small  angle  and  constant  to  assumption.  Equation  (11), 
developed  for  time  varying  to,  does  not  consider  large  angle  motion  seen  in  the 
experiment  or  coupling  dynamics  linking  the  RUM  to  the  payload  (or  telescope).  A 
systems-level  modeling  approach  must  be  used  to  accurately  account  for  the  coupling 
of  the  RUM  device  to  the  telescope  dynamics. 

Robotics  provides  a  large  body  of  knowledge  that  is  applicable  to  the  model. 
The  physical  makeup  of  the  plant  and  RUM  devices,  as  seen  in  Figure  8,  resembles  the 
make-up  of  robotic  mechanisms.  The  robotics  approach  addresses  individual 
component  interaction  thus  identifying  detailed  dynamics  not  found  in  simpler 
modeling  techniques.  Well-developed  robotic  kinematics  and  kinetics  concepts 
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provide  a  systematic  approach  to  system  modeling  of  this  problem.  This  chapter 
presents  an  overview  of  the  general  modeling  approach  applying  the  Lagrange 
Formulation.  It  is  organized  in  a  ‘top-down’  manner  starting  with  basic  concepts  of 
the  Lagrange  Formulation  including  expressions  for  the  kinetic  and  potential  energy. 
Since  these  expressions  require  kinematic  calculations,  kinematics  is  presented  next. 
Finally,  an  outline  of  the  Lagrange  Formulation  steps  is  given  to  summarize  the  entire 
process.  The  formulation  results  in  a  dynamical  model  of  the  entire  manipulator  in 
terms  of  all  joint  variables.  The  equations  of  motion  give  the  designer  physical  insight 
needed  to  understand  the  behavior  of  the  overall  system.  Chapter  4  describes  the 
Lagrange  Formulation  specifically  applied  to  the  RUM  actuated  system. 

3.1  Lagrange  Formulation  -  Basic  Concepts 

The  Lagrange  formulation  [10]  is  derived  from  Hamilton’s  principle,  one  of 
the  most  basic  principles  of  mechanics  [15].  The  development  presented  here  is  based 
on  a  robotics  application.  Figure  14  shows  a  general  system  of  components  or  links. 
The  variable  qt  at  each  joint  defines  the  link’s  motion  within  its  own  frame  of 
reference,  thus  making  the  qts  independent  from  each  other.  The  qi  can  be  a 
rotational  variable  for  a  revolute  joint  (Joints  1  and  2  of  Figure  14)  or  a  translational 
variable  for  a  prismatic  joint  (as  in  Joint  of  Figure  14).  The  motion  of  link  i  affects 
the  motion  of  links  /+!  to  A^for  an  link  system. 
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Figure  14  -  Link  Manipulator 


The  Lagrange  Formulation  provides  a  systematic  approach  to  dynamic  modeling  that 
accounts  for  the  effects  of  the  joint  motions  on  system  dynamics.  The  objective  of  the 
Lagrange  Formulation  is  to  relate  the  joint  position  variable,  qt,  and  the  joint  velocity 
variable,  q^ ,  to  the  potential  and  kinetic  energies  of  the  system.  The  kinetic  and 
potential  energies  are  then  used  to  develop  the  Lagrange  Energy  Function  which  in 
turn  is  used  to  calculate  the  equations  of  motion  for  the  entire  system.  The  Lagrange 
energy  function  for  a  system  is  defined  in  Equation  (12).  The  variable  ^is  a  vector  of 

N  independent  variables  as  previously  defined,  q(t)  -  [^,  (/)  •  •  •,  q^  (^)f ,  describing 

the  motion  of  a  manipulator  with  joints.  K(^)  and  P(»)  are  the  kinetic  energy  and 
potential  energy  expressions  for  the  manipulator  respectively. 

Once  the  energy  function  is  specified,  the  equations  of  motion  for  the  manipulator  are 
obtained  through  the  Euler-Lagrange  equation  defined  in  Equation  (13). 
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d_  dL{q,q,t) 
dt  ^q^ 


dL{q,^,t) 


(13) 


Where:  /  =  1,  ...,N  and  Ft  is  the  generalized,  non-conservative  force  acting  in  the 
direction  of  the  qt  coordinate  (i.e.  external  forces,  frictions,  etc  ).  The  general  model 
resulting  from  the  Lagrange  Formulation  is  of  the  form  defined  in  Equation  (14).  The 
first  term  on  the  left  side  of  the  equation  is  associated  with  the  manipulator  inertia. 
The  second  term  represents  the  coriolis  and  centripetal  forces  and  is  associated  with 
the  manipulator  kinetic  energy.  The  third  term  signifies  the  gravity  effects  and  is 
associated  with  the  potential  energy.  The  term  on  the  right  side  of  Equation  (14) 
specifies  the  generalized  forces  acting  on  each  joint.  In  robotics,  this  term  represents 
the  control  input(s)  to  the  system. 


(14) 

H  (q)q  +  C  (q,  q)q  +  G{q)  =  F 

Expressions  for  the  kinetic  and  potential  energies  as  functions  of  the  joint  variables, 
q  and  q ,  must  be  developed  for  each  link  of  the  system  to  use  the  formulation  in 

Equations  (14).  The  kinetic  and  potential  energy  expressions  are  developed  in  the 
next  few  sections. 


3.1.1  Potential  Energy 

Potential  energy  is  a  function  of  the  position  of  the  manipulator  components 
therefore  it  is  configuration  dependent.  The  configuration  can  be  described  as  a 
function  of  the  joint  variables,  q,  thus  making  potential  energy  a  function  of  ^as  well 
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[16],  Equation  (15)  represents  the  general  form  of  potential  energy  for  the  /th  link  of 
the  system  connected  to  the  /-I  coordinate  frame  as  shown  in  Figure  15. 


Pi  = 


(15) 


where;  w,  =  mass  of  rth  link,  g  =  gravity  vector,  and  =  position  vector  for  rth  link 
center  of  mass  in  reference  to  the  7-1  coordinate  frame. 


link  7 


base  frame 


Figure  15  -  Relative  Position  of  Link  Center  of  Mass 

The  total  potential  energy  of  the  system  is  the  sum  of  the  potential  energy  of  each 
link,  since  potential  energy  is  a  scalar  quantity.  To  accomplish  this  summation,  each 
term  in  the  summation  must  be  represented  in  a  common  reference  frame.  In  robotics, 
the  base  coordinate  frame  is  generally  used  as  the  common  reference  and  the  gravity 
vector  is  expressed  in  that  frame.  Therefore  the  position  vector,  ,  must  be 

represented  in  the  base  coordinate  frame.  This  involves  a  homogeneous 
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transformation  which  accounts  for  translation  and  rotation  between  coordinate  frames 
based  on  qt,  the  joint  variable.  Let  Ao'^  be  the  homogeneous  transformation  between 
frames  /-I  and  0,  the  base  frame.  Then  the  total  potential  energy,  P,  can  be  expressed 
as  in  Equation  (16). 

P  =  (16) 

This  concept  will  be  discussed  further  in  the  development  of  kinematic  equations  in 
Section  3.2  to  follow.  In  summary,  the  potential  energy  is  a  function  of  ^because  the 
position  vector  represented  in  the  base  frame  involves  homogeneous  transformations 
that  are  a  function  of  q . 

3.1.2  Kinetic  Energy 

The  kinetic  energy  of  each  link  is  developed  in  a  manner  similar  to  that  for 
potential  energy.  However,  the  calculations  are  complicated  by  the  fact  that  the  total 
kinetic  energy  is  composed  of  translational  and  rotational  components.  Equation  (17) 
represents  the  kinetic  energy  for  the  rth  link  of  the  system.  The  first  term  is  the 
translational  kinetic  energy  based  on  linear  velocity  vector,  v^. ,  of  the  center  nf  mass 
of  the  link.  The  second  term  is  the  rotational  kinetic  energy  based  on  the  angular 
velocity  vector  of  the  link  and  the  moment  of  inertia  of  the  link,  g5,  and  /,  respectively. 
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(17) 


Since  kinetic  energy  is  a  scalar  function,  the  total  kinetic  energy  of  the  system  is  the 
sum  of  the  kinetic  energy  of  each  link  provided  there  is  a  common  frame  of  reference 
for  the  calculations.  This  requires  a  mapping  fimction  called  the  manipulator  Jacobian 
that  relates  the  joint  velocities,  q^,  to  linear  and  angular  velocity  in  base  frame 
coordinates  (Figure  16). 


Figure  16  -  Manipulator  Jacobian  Mapping 


The  relationship  between  the  linear  velocity,  ,  and  joint  velocities  is  described  in 
Equation  (18)  [16  ]. 


(18) 


where:  Jl~  the  'ixN  linear  velocity  Jacobian  for  the  /th  link, 
the  vector  of  iV  joint  velocities  for  an  A'^link  system. 
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Similarly,  the  relationship  between  the  angular  velocity,  and  joint  velocities  is 
described  by  Equation  (19). 


ffl,  = 


(19) 


where:  =  the  3  x  TV  angular  velocity  Jacobian  for  the  /th  link.  Since  these 

Jacobians  are  configuration  dependent,  they  are  functions  of  q .  Thus,  kinetic  energy 

is  generally  a  function  of  q  and  q .  The  calculations  for  the  Jacobians  are  addressed  in 

Section  3.2.3  to  follow.  The  manipulator  Jacobian  accounts  for  the  mapping  of  q  to 
V  and  CO  in  the  base  coordinate  frame  but  does  not  take  into  account  how  these  terms 
are  multiplied  in  Equation  (17).  The  linear  terms  can  be  multiplied  without  reference 
to  any  particular  frame  since  the  product  v„  is  simply  the  square  length  of  the 
vector  v„.  .  Transforming  v^.  into  a  different  reference  frame  does  not  change  its 

length,  but  only  rotates  it  [17].  Therefore,  the  translational  kinetic  energy  for  link  / 
can  be  expressed  as  in  Equation  (20). 


(20) 


Similarly,  the  triple  product  of  7,  ®,  in  the  rotational  kinetic  energy  term  does  not 

need  to  be  referenced  to  any  particular  coordinate  frame  thus  making  the  summation 
of  the  translational  kinetic  energy  and  the  rotational  kinetic  energy  in  Equation  (17) 
possible  without  regard  to  any  particular  reference  frame.  There  is  a  requirement. 
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however,  that  and  I  be  in  the  same  frame  in  order  to  calculate  the  triple  product. 
In  the  calculation  of  a>^  in  Equation  (19),  multiplying  q  by  J\  puts  5,  into  the  base 
coordinate  frame.  Therefore,  /,  must  be  expressed  in  the  base  frame  or  must  be 
transformed  into  the  same  frame  in  which  /,  is  expressed.  It  is  generally  simpler  to 
express  7,  in  the  link  coordinate  frame.  Therefore,  will  be  expressed  in  the  link 
frame  as  shown  in  Equation  (21). 


where:  R\ '  is  the  rotational  transformation  from  the  base  frame  to  the  rth  link  frame. 

Note  that  Ro^  is  an  orthogonal  submatrix  of  the  homogeneous  transformation  Ao\ 
Therefore,  {Ro^f  is  the  inverse  of  7?o'^.  Thus,  the  rotational  kinetic  energy  can  be 
expressed  as  in  Equation  (22). 


J’K'iXK'y  JA 


(22) 


It  follows  from  Equations  (21)  and  (22),  the  total  kinetic  energy  of  an  N  link  system 
can  be  expressed  as  in  Equation  (23). 


2=1 


(23) 


In  summary,  the  kinetic  energy  requires  a  mapping  between  joint  space 
velocity  variables,  q,  and  the  base  coordinate  frame  velocity  variables,  vand  S>  thus 
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making  kinetic  energy  a  function  of  q  and  ^  since  the  Jacobian  (mapping  function)  is  a 
function  of  q .  The  next  several  sections  discuss  the  calculations  of  the  kinematics  of 
a  mechanical  system.  These  kinematics  are  required  in  order  to  accomplish  the 
mapping  necessary  for  the  potential  and  kinetic  energy  calculations. 

3.2  Kinematics 

Kinematics  is  the  branch  of  mechanics  that  deals  with  the  motion  of  rigid 
bodies  without  reference  to  their  masses  or  forces  producing  the  motion  [10]. 
Basically,  kinematics  defines  the  geometry  of  the  system,  and  the  coordinate  systems 
chosen  determine  the  mathematical  relations  developed.  The  objective  of  kinematic 
modeling  is  to  determine  the  cumulative  effects  of  the  entire  set  of  joint  variables. 
Kinematic  modeling  can  be  divided  into  two  areas:  Position  kinematics  and  velocity 
kinematics.  In  each  area  the  goal  is  to  relate  knowledge  of  the  manipulator  joint 

variables,  q  and  q ,  to  the  movement  of  the  entire  system.  The  next  several  sections 
describe  this  relationship. 

3.2.1  Position  Kinematics 

Position  kinematics  involves  the  representation  of  points  in  one  reference 
frame  to  that  of  another  frame.  Figure  17  shows  the  position  vector  of  point  P  in 
reference  to  different  frames.  If  knowledge  about  point  P  is  obtained  in  one  frame, 
position  kinematics  enables  that  knowledge  to  be  represented  in  another  frame. 
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"‘Xn 

Figure  17  -  Position  Representation 


The  tool  for  accomplishing  these  different  representations  is  called  the  homogeneous 
transformation  [16],  In  general,  this  transformation  accounts  for  rotations  and 
translations  in  three  dimensional  space  by  using  a  matrix  of  the  form  shown  in 
Equation  (24). 


^3x1 

rotationsubmatrix 

translationvector 

_/lx3 

*^1x1  _ 

perspectivevector 

scalingvector 

(24) 


This  matrix  converts  the  coordinates  of  a  point  expressed  in  the  /th  (xi,yi,Zi)  coordinate 
frame  to  the  coordinates  of  the  same  point  described  in  the  /-I  (xi.i,yi.i,Zj.i)  coordinate 
system.  The  translation  vector  describes  the  translation  between  the  origins  of  the  /-I 
and  /th  coordinate  systems.  The  rotation  matrix  is  a  3x3  submatrix  specifying  the 
rotation  of  the  /th  coordinate  system  relative  to  the  /-I  coordinate  system.  The  scaling 
factor  can  be  used  to  adjust  the  desired  scale  for  the  components  of  the  translation 
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vector  but  is  generally  specified  as  1  for  robotics  applications.  The  perspective  vector 
may  be  applied  to  determine  the  position  (size)  of  an  object  image  using  the  focal 
length  of  a  camera  for  optical  sensing  but  will  be  zero  in  this  robotics  application.  The 
components  in  this  matrix  are  functions  of  the  joint  variable  q  and  the  manipulator 
configuration.  Therefore,  in  order  to  represent  point  P  (in  Figure  17)  in  terms  of 
reference  frame  0  given  its  position  vector  in  reference  frame  N,  the  following 
transformations  must  be  used. 


Note  that  the  position  vectors  must  be  augmented  by  1  to  account  for  the  translational 
part  of  the  transformation.  If  the  transformation  is  purely  rotational,  then  A|_^ 

simplifies  to  Equation  (26).  A  short  hand  notation  given  for  Equation  (26)  is 
Rotaxis, angle  which  specifies  the  axis  and  angle  of  rotation. 


0 

1 


(26) 
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If  the  transformation  is  purely  translational,  then  A^j  simplifies  to  Equation  (27).  A 

short  hand  notation  given  for  Equation  (27)  is  Transaxis.distance  which  specifies  the  axis 
and  distance  of  translation. 


(27) 


Different  combinations  of  these  two  simple  forms  can  result  in  the  representation  of 
transformations  between  any  two  reference  frames.  For  example,  point  P  in  Figure  18 
can  be  represented  in  two  reference  frames.  The  frames  are  separated  by  a  distance  -a 
along  the  xo  axis  and  the  rotation  9  about  the  zq  axis.  9  is  measured  from  the  xo  axis  to 
the  projection  of  the  xj  axis  into  the  0*  frame. 


P 


Figure  18  -  Example  Transformation 


Letting  Rl  be  the  rotation  submatrix  of  Al ,  the  problem  can  be  broken  down  into  a 
simple  rotation  and  a  simple  translation  as  shown  in  Equation  (28). 
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P,=lflP,+4 

>  “ 

°  =  Rot .  gTrans  ^  „ 


cos^  -sin0 
sin^  cos^ 
0  0 

0  0 


0 

0 

1 

0 


-a 

0 

0 

1 


P^ 

1 


(28) 


Multiplying  the  rotation  and  translation  matrices  results  in  the  homogeneous 
transformation,  Al ,  between  frames  0  and  1 .  This  approach  allows  for  a  large  amount 
of  flexibility  in  determining  transformations  between  reference  frames.  A  more 
systematic  approach  is  the  Denavit-Hartenberg  (DH)  convention  addressed  in  the  next 
section. 

3.2.2  Denavit-  Hartenberg  (DH)  Convention 

The  DH  convention  is  a  systematic  approach  that  uses  the  minimum  number  of 
parameters  to  describe  kinematic  relationships  by  restricting  the  types  of  rotations  and 
translations  allowed  [10].  Rotations  and  translations  are  only  allowed  about  or  along 
the  X  and/or  z  axis.  The  joint  variable,  qi,  is  also  restricted  to  a  single  variable  per 
joint  always  about  or  along  the  z  axis  defined  for  that  reference  frame.  The  joint 
variable  is  further  restricted  to  be  either  a  single  translational  variable  or  a  single 
rotational  variable  but  not  both.  Applying  the  DH  convention  to  the  homogeneous 
transformation  results  in  an  Al_^  matrix  defined  in  Equation  (29). 
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=  Rot^g^  Trans  Trans, ,  Rot, 


'x,ar 


(29) 


where[10]: 

^  =  angle  of  rotation  about  the  positive  Z/.j  axis  measured  from  the  positive  x,.y  axis  to 
the  positive  x,  axis  (or  its  parallel  projection)  where  the  positive  direction  is 
counterclockwise  (joint  variable  for  a  revolute  joint), 

di  =  offset  distance  measured  along  the  z,.;  axis  from  the  origin  of  the  i-1  frame  to  the 
intersection  of  the  Z/.y  axis  and  the  X/  axis  (joint  variable  for  a  prismatic  joint), 
a,  =  link  length  measured  along  the  x,  axis  from  the  origin  of  the  frame  to  the  to  the 
intersection  of  the  z,.y  axis  and  the  x,  axis  (constant), 

Ui  =  twist  angle  between  two  joint  axes  measured  about  the  positive  x,  axis  from  the 
positive  z,.y  axis  (or  its  parallel  projection)  to  the  positive  Z;  axis  where  the  positive 
direction  is  counterclockwise  (constant). 

Figure  19  shows  an  example  of  applying  the  DH  convention  to  a  simple  manipulator. 
Table  1  lists  the  parameters  for  each  joint  of  the  system.  Note  that  the  (  )*  signifies 
the  joint  variable,  qt,  and  that  the  joints  are  numbered  starting  with  1  at  reference 
frame  0. 
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Z3 

Figure  19  -  DH  Convention  Example 
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Table  1  -  Joint  Parameters 


The  general  form  of  the  homogeneous  transformation  incorporating  the  DH 
convention  is  shown  in  Equation  (30). 


cosOf 

sin 

0 

0 


-  sin  cosa^ 
cos^^  cos  a, 
sin  a, 

0 


sin  0^  sin  a,. 
-  cos^,  sin  or, 
cos  a, 

0 


a,  cos^, 
a,  sin 

1 


(30) 
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There  are  several  advantages  to  using  the  DH  convention  in  the  development 
of  kinematic  relationships.  It  provides  a  systematic  approach  to  defining  these 
relationships  with  only  4  parameters.  It  also  makes  the  manipulator  Jacobian 
calculations  simpler  since  the  joint  variable,  qt,  is  always  defined  with  reference  to  the 
z  axis  in  the  local  frame.  There  are  some  disadvantages,  however,  to  using  the  DH 
convention.  The  main  drawback  is  that  a  “dummy  link”  or  “dummy  joint”  may  have 
to  be  incorporated  to  abide  by  the  restrictions  placed  on  the  homogeneous 
transformation.  In  the  RUM  actuated  system  development  presented  in  the  next 
chapter,  a  “dummy  link”  and  2  “dummy  joints”  are  required  in  order  to  apply  the  DH 
convention  to  this  system. 

3.2.3  Velocity  Kinematics 

Velocity  kinematics  involves  the  development  of  the  manipulator  Jacobian 
discussed  in  Section  Kinetic  Energy  which  relates  the  joint  velocities,  q ,  to  linear  and 
angular  velocities  in  the  base  coordinate  frame.  The  following  development  assumes 
the  DH  convention  is  used  to  set  up  the  kinematic  relationships. 

3.2.3.1  Angular  Velocity  Jacobian 

The  angular  velocity  of  link  j  attached  to  the  revolute  joint  j  is  the  vector 
as  shown  in  Figure  20.  If  the  angular  velocity  of  link  j  is  written  in  the 

base  coordinate  frame,  it  can  simply  be  added  to  angular  velocities  from  other  revolute 
joints  when  they  are  also  Avritten  in  the  base  frame. 
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Figure  20  Angular  Velocity  Vectors  for  Revolute  Joints 

A  prismatic  joint  adds  no  angular  velocity  to  the  system.  Therefore,  the  total  angular 
velocity  of  the  rth  link,  in  reference  to  the  base  frame,  is  the  sum  of  all  the  angular 
velocities  contributed  by  the  1  to  z  revolute  joints.  Joints  z+l  to  N  do  not  contribute  to 
the  angular  velocity  of  the  z’th  link.  Equation  (31)  demonstrates  this  vector  addition. 

G>f*  —  0}^+ 0)2+”"  + 0)j  +'”  +  3j 

=  +  6,^2  +  •  •  •  +  bj_^qj  +  •  •  •  +  b^_^q. 

=  J'^yq■^  ■^J'a2^2+'"  +  +  •  •  •  +  J\^q^ 

where ;  b._^  =  ,  the  representation  of  z^.,  in  the  base  frame 

J\  =  the  angular  velocity  Jacobian  for  the  i*  link. 
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Therefore,  the  ^h  component  of  the  angular  velocity  Jacobian  for  the  /th  joint  is 
simply  bJ_■^  for  a  revolute  joint  and  zero  for  a  prismatic  joint.  Equation  (32) 
summarizes  the  construction  of  the  angular  velocity  Jacobian,  Ja‘  ,  for  the  /th  link. 


(32) 


where: 


for  a  revolute  joint 
for  a  prismatic  joint 


3.2.3.2  Linear  Velocity  Jacobian 

Similarly,  the  linear  velocity  of  the  center  of  mass  of  link  j  attached  to  the 
prismatic  jointy  is  the  vector  =  Zj_^qj  as  shown  in  Figure  21 .  If  the  linear  velocity 

of  link  j  is  written  in  the  base  coordinate  frame,  it  can  simply  be  added  to  linear 
velocities  from  other  prismatic  joints  when  they  are  also  written  in  the  base  frame. 
Therefore,  theyth  component  of  the  linear  velocity  Jacobian  for  the  yth  prismatic  joint 
is  bj_^ ,  the  representation  of  in  the  base  frame. 


48 


base  frame 
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joint  1 


linkN  joint  N 

Figure  21  -  Linear  Velocity  Vectors  for  Prismatic  Joints 


The  development  of  the  linear  velocity  Jacobian  for  a  revolute  joint  is  more 
complicated,  however,  since  a  revolute  joint  contributes  a  linear  velocity  term  that  is 
tangential  to  the  motion  of  the  link.  Figure  22  shows  the  linear  velocity  contribution 
of  revolute  joint  j  to  the  center  of  mass  of  link  /, 
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Figure  22  -  Linear  Velocity  Vector  for  Revolute  Joints 


The  velocity  vector  of  the  center  of  mass  of  link  /  can  be  written  as  in  Equation  (33). 


(33) 


Where:  ^  is  the  position  vector  from  the  /th  joint  to  the  center  of  mass  of  the  /th 

link.  Once  this  velocity  vector  is  written  in  terms  of  the  joint  variable  and  the  base 
coordinate  frame,  it  can  also  be  added  to  other  linear  velocity  terms.  This  requires  that 
c^j  and  „  be  written  in  terms  of  the  base  frame.  The  angular  velocity  vector  is 

equal  to  cOj  =  bj.xqj  as  presented  previously.  To  represent  the  position  vector,  ^ , 
in  the  base  coordinate  frame  requires  vector  addition  as  shown  in  Figure  23. 
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center  of  mass 
of  link  i 


Figure  23  -  Position  Vector  Representation 


Since  „  and  can  be  represented  in  the  base  frame  by  using  the  homogeneous 
transformations  developed  for  the  system,  „  is  represented  in  the  base  frame  by 
their  vector  subtraction  as  seen  in  Equation  (34). 

f  -r  =r  (34) 


Where  „  and  are  represented  in  the  base  coordinate  frame.  Therefore,  the  ;th 

link’s  linear  velocity  contribution  from  the ^h  revolute  joint  is  represented  in  Equation 
(35). 


=  (Vi 


(35) 
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The  total  linear  velocity  of  the  rth  link,  in  reference  to  the  base  frame,  is  the  sum  of  all 
the  linear  velocities  contributed  by  the  1  to  i  prismatic  and  revolute  joints.  Joints  /+! 
to  N  do  not  contribute  to  the  linear  velocity  of  the  ;th  link.  Equation  (36)  demonstrates 
this  vector  addition. 

vf  =v^,+v,2+-  +  v^.+-  +  v^ 

=  J'lAx  +  +  •  ’  •  +  J'Ljqj  +  •  •  •  +  J'uQi 

=  J[q 

Where  is  the  linear  velocity  Jacobian  for  the  /th  link.  Equation  (37)  summarizes  the 
construction  of  the  linear  velocity  Jacobian  for  the  /th  link. 


(37) 


Where : 


X  (^o,d  -  Kj-\)  for  a  revolute  joint 
for  a  prismatic  joint 


3.3  Summary  of  Lagrange  Formulation  Steps 

In  summary,  the  Lagrange  Formulation  results  in  the  dynamic  equations  of 
motion  for  mechanical  systems.  The  process  involves  several  steps  in  determining  the 
relationships  between  joint  variables  and  kinetic  and  potential  energy.  This 
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information  is  then  used  to  calculate  the  Euler-Lagrange  equations  of  motion.  This 
section  provides  a  brief  outline  of  the  steps  to  the  Lagrange  formulation  using  the  DH 
convention. 

Step  1 .  Assign  a  coordinate  frame  to  each  joint  of  the  manipulator. 

•  Use  the  DH  convention  when  it  is  appropriate. 

Step  2.  Define  coordinate  frame  parameters  for  each  joint:  ai ,  ai ,  di ,  0i . 

Step  3.  Determine  the  homogeneous  transformations  between  each  coordinate  frame 

using  Equation  (3.19)  repeated  here. 

cos^,  -  sin  Of  costtf  sin  9^  sin  a,  a,  cos^, 
sin  Of  cos  Of  cos  a,  -  cos  sin  a,  a,  sin  Of 

0  sin  a,  cos  a,  df 

0  0  0  1 

Step  4.  Determine  the  position  kinematic  equations  relating  each  link  of  the 

manipulator  to  the  base  coordinate  frame. 

Step  5.  Determine  the  velocity  kinematics. 

•  Requires  calculation  of  the  Manipulator  Jacobian  for  each  link  using 
Equations  (32)  and  (37)  repeated  here. 

-  4  -  4  0  -  o] 

bj_j  for  a  revolute  joint 

0  for  a  prismatic  joint 


4=  [4  •••  4  -  4  0  -  o] 


4  = 


bj-x 


for  a  revolute  joint 
for  a  prismatic  joint 


•  Use  Manipulator  Jacobian  to  calculate  linear  and  angular  velocities  from 
joint  velocities  using  Equations  (31)and  (35)repeated  here. 

% 


Step  6.  Calculate  the  potential  energy  for  each  link  with  reference  to  the  base 
coordinate  frame  using  Equation  (16)  repeated  here. 

P  = 

1=1 

Note  that  n  will  have  to  be  augmented  by  1  when  multiplying  by  Ao’  to  account 
for  the  translational  part  of  the  homogeneous  transformation. 

•  Requires  calculation  of  the  position  vector  of  the  center  of  mass  of  each 
link  relative  to  the  base  coordinate  frame  using  the  kinematic  equations 
from  step  4. 

Step  7.  Calculate  the  kinetic  energy  for  each  link  with  reference  to  the  base 
coordinate  frame  using  Equation  (23)  repeated  here. 
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Step  8.  Calculate  the  Lagrangian  energy  function,  L{q,q.t) ,  by  subtracting  potential 
energy  from  kinetic  energy. 

Step  9.  Calculate  the  equations  of  motion  for  the  manipulator  through  the  Euler- 
Lagrange  equation  defined  in  Equation  (13)repeated  here. 

^  ^L{q,q,t)  dL{q,q,t)  ^ 

dt\_  ^q^  J  ^q^ 


CHAPTER  4 


RUM-ACTUATED  SYSTEM  MODELING 


There  are  several  benefits  to  applying  Chapter  3  concepts  to  modeling  the 
RUM  actuated  system.  It  is  a  systematic  approach  to  modeling  complex  systems  and 
it  produces  a  complete  dynamic  model.  Applying  the  Denavit-Hartenburg  coordinate 
convention  and  the  Lagrange  Formulation  to  standard  robotic  manipulators  is 
generally  straightforward  since  robots  are  designed  specifically  and  efficiently  to 
perform  certain  tasks.  There  are  certain  drawbacks,  however,  to  directly  applying  this 
formulation  to  the  RUM  actuated  system.  The  RUM  system  is  unique  in  a  robotics 
sense  since  it  is  not  an  efficient  use  of  joints  or  links  and  is  under-actuated,  having 
only  the  RUM  torque  motors  for  actuation.  It  would  take  six  links  and  joints  (some 
dummy)  to  represent  this  system  that  only  has  three  degrees  of  freedom.  Certain 
physical  properties  of  the  RUM  system  can  be  used  to  reduce  the  system  order  and 
complexity  if  taken  into  account  during  the  modeling  process.  Therefore,  in  order  to 
benefit  from  the  systematic,  detailed  aspects  of  the  Lagrange  Formulation  without 
unduly  complicating  the  model,  special  insight  and  some  modifications  are  required. 
All  RUM  actuated  systems  will  require  similar  modifications  and  considerations  when 
applying  the  Lagrange  Formulation.  The  modifications  are  divided  up  into  two 
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groups;  Kinematic  modifications  and  dynamic  modifications.  The  development  of  the 
RUM  actuated  system  equations  of  motion  using  these  modifications  is  presented  in 
this  chapter. 

4.1  Kinematic  Modiflcations 

Recall  that  the  objective  of  kinematic  modeling  is  to  determine  the  cumulative 
effects  of  the  entire  set  of  joint  variables.  The  next  several  sections  will  discuss 
physical  properties  of  the  RUM  system  along  with  modeling  assumptions,  position 
kinematic  modifications  and  velocity  kinematic  modifications  used  to  reduce  model 
order  and  complexity. 

4.1.1  Modeling  Assumptions  and  System  Properties 

Three  modeling  assumptions  are  made  during  the  development  of  the 
equations  of  motion.  The  first  assumption  is  that  no  rotational  motion  about  the  line  of 
sight  axis  is  possible.  This  is  a  valid  assumption  for  the  test  configuration  described  in 
Chapter  2  since  the  gimbal  mount  only  allows  cross-elevation  and  elevation  axes 
motion.  The  second  assumption  is  that  the  RUM  mass  arms  are  controlled  to  maintain 
the  180®  spatial  displacement.  Note  that  the  masses  are  not  physically  held  in  these 
positions  by  hardware  but  must  be  controlled  to  maintain  this  displacement.  This 
property  allows  a  model  reduction  since  the  RUMs  can  be  treated  as  a  single  actuator. 
The  last  assumption,  that  the  mass  of  the  RUM  link  may  be  treated  as  a  ‘point  mass’ 
located  at  the  center  of  mass  of  that  link,  is  a  valid  assumption  since  the  mass  of  the 
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RUM  is  much  larger  than  the  mass  of  the  rod  attaching  the  RUM  to  the  telescope  and 
the  center  of  mass  of  the  RUM  link  is  located  near  the  end  of  the  link  arm.  This 
assumption  also  allows  for  a  simplified  model  as  discussed  in  Section  4.1.3  to  follow. 

4.1.2  Position  Kinematic  Modiflcations 

Position  kinematics  must  be  used  to  properly  model  the  RUM  positions, 
regardless  of  the  modeling  approach  used.  Certain  considerations  in  position 
kinematics,  however,  will  simplify  the  velocity  kinematics  and  system  dynamics 
developed  in  Sections  4.1.3  and  4.2  respectively.  Figure  24  shows  the  RUM  actuated 
system  diagram.  Since  the  circular  scan  RUMs  are  the  only  actuators  used  in  this 
model  development,  the  elevation  and  cross-elevation  torque  motors  have  been 
removed,  as  well  as  the  linear  scan  RUMs.  The  joint  variables  are  identified  with  0i 


as  indicated. 
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Figure  24  -  RUM  Actuated  System  Diagram 

There  is  a  2-degree-of-freedom  gimbal  joint  at  the  center  mount  of  the  beam  (or 
telescope).  Since  the  DH  convention  is  used,  this  joint  will  be  modeled  with  two 
distinct  coordinate  frames  with  origins  separated  by  a  distance  of  zero.  The  telescope 
body  can  be  modeled  in  several  ways.  Each  method  results  in  the  same  equations  of 
motion  but  requires  different  calculations  for  the  velocity  kinematics.  The  telescope  is 
treated  as  a  single  link  to  simplify  the  velocity  kinematics  in  Section  4.1.3.  However, 
several  dummy  frames  and  joints  must  be  included  in  the  model  to  ensure  the  proper 
configuration  of  the  RUM  system  and  to  account  for  the  geometry  of  the  system. 
Figure  25  shows  the  coordinate  frames  used  to  model  the  RUM  system.  Reference 
frame  0  signifies  the  elevation  axis  motion  while  reference  frame  1  signifies  the  cross¬ 
elevation  axis  motion.  The  DH  convention  also  requires  that  a  “dummy”  link  and 
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joint  be  used  between  reference  frames  1  and  2.  Reference  frames  3  and  5  signify  the 
attachment  points  of  the  RUM  actuator.  Reference  frames  4  and  6  are  attached  to  the 
end  of  the  RUM  mass  and  are  required  to  determine  the  relative  displacement  of  the 
RUM  mass  from  the  other  reference  frames. 


telescope  body  5^4  RUM 


Figure  25  -  RUM  System  Coordinate  Frames  (DH  Convention) 

Table  2  defines  the  joint  parameters  for  the  RUM  actuated  system.  In  order  to 
maintain  the  correct  telescope  orientation,  90®  must  be  added  to  the  02  variable.  The 
parameters  defined  by  ( )*  are  the  joint  variables,  qi.  To  ensure  that  the  RUMs  are 
kept  at  the  180°  spatial  displacement,  r’  is  used  in  the  6*  joint  parameter  and  the 
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RUM  rotation  variables,  06  and  04,  will  be  set  equal  to  each  other  in  the  dynamic 
modifications  in  Section  4.2.  This  modification  simplifies  the  calculations  and  enables 
a  reduction  of  the  system  order  later  in  the  development.  Note  that  joints  3  and  5  have 
all  constant  parameters.  These  are  required  for  kinematic  ‘bookkeeping’  to  ensure 
compliance  with  the  DH  convention  and  the  proper  orientation  of  the  telescope  and 
RUMs.  Although  the  position  kinematics  are  complicated  because  of  two  ‘dummy’ 
joints,  the  velocity  kinematics  can  be  simplified  since  the  constant  parameters  do  not 
add  dynamics  to  the  system  model. 


Joint 

ai 

OCi 

di 

0i 

1 

0 

+90” 

0 

01* 

2 

0 

+90” 

0 

02* +90" 

3 

0 

0 

d 

0 

4 

r 

0 

0 

04* 

5 

0 

0 

-d 

0 

6 

-r 

0 

0 

06* 

Table  2  -  RUM  System  Joint  Parameters 

4.1.2.1  Homogeneous  Transformation  Modifications 

The  RUM  system  is  unique  in  terms  of  robotic  homogeneous  transformations. 
Normally,  a  kinematic  chain  of  equations  relates  the  N*  link  to  the  base  coordinate 
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frame  by  passing  through  all  the  other  links.  However,  a  RUM  link  (or  arm)  is 
attached  to  each  end  of  the  telescope  requiring  distinctly  different  kinematic  chains. 
Therefore,  the  homogeneous  transformations  and  the  kinematic  equations  go  from  the 
base  frame  0  out  to  frame  4  for  the  first  RUM.  For  the  second  RUM,  the 
transformations  and  equations  go  from  the  base  frame  0  through  frames  1  and  2  again, 
and  then  to  frames  5  and  6.  MapleV*™,  a  symbolic  computation  program,  was  used  to 
facilitate  these  calculations.  Appendix  A  provides  detailed  results  of  the  homogeneous 
transformations.  The  kinematic  equations  for  the  first  and  second  RUMs  are  shown  in 
Equations  (38)  and  (39)  respectively. 


a:  =  AlAfA^,A 


A^  =  AlAfA^A^ 


(38) 


(39) 


4. 1.2.2  Potential  Energy  Simplification 

Since  the  system  is  gimbaled  at  the  center  of  mass  of  the  telescope,  the 
potential  energy  of  one  half  of  the  telescope  is  equal  and  opposite  to  the  other  half  of 
the  telescope  when  calculated  in  terms  of  the  base  coordinate  frame.  Therefore,  the 
potential  energy  of  the  entire  telescope  is  equal  to  zero  since  the  two  halves  cancel 
each  other  when  added.  If  the  180°  spatial  displacement  is  maintained  between  the 
masses  of  the  RUM  arms,  their  potential  energy  will  be  equal  and  opposite  as  well 
thus  resulting  in  a  zero  potential  energy.  Therefore,  assuming  a  180°  RUM  spatial 
displacement,  the  total  potential  energy  of  the  entire  system  is  zero. 
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4.1.3  Velocity  Kinematic  Modiflcations 

The  physical  properties  analyzed  in  the  previous  sections  facilitate  the 
development  of  velocity  kinematics.  The  different  links  of  the  RUM  actuated  system 
contribute  different  components  to  the  kinetic  energy.  Each  link  can  contribute  a 
linear  velocity  term,  an  angular  velocity  term  or  both  as  shown  in  Equation  (40) 
repeated  here  from  Chapter  3. 


1=1 


n  0 

linear  vel  ocity  angular  velocity 

terms  terms 


(40) 


These  terms  are  based  on  the  mass  of  each  link,  the  inertia  about  the  center  of  mass  of 
each  link,  and  the  velocity  of  the  center  of  mass  of  each  link.  Figure  26  shows  the 
five  links  of  the  RUM  actuated  system  and  RUM  and  telescope  centers  of  mass 
necessary  for  analysis. 
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link  3  center  of 


Figure  26  -  Links  of  the  RUM  Actuated  System 

Links  1  and  2  have  zero  kinetic  energy  since  there  is  no  mass  or  inertia  in  either  link. 
The  mass  and  inertia  of  the  telescope  is  contained  entirely  in  link  3.  Modeling  the 
telescope  as  a  single  link  simplifies  the  kinetic  energy  calculation  for  link  3  since  it 
rotates  about  its  center  of  mass.  This  motion  produces  only  rotational  kinetic  energy 
since  the  link  rotates  about  its  center  of  mass  and  the  center  of  mass  does  not  translate. 
Modeling  links  4  and  5,  the  RUM  arms,  as  point  masses  further  reduces  the 
complexity  of  the  velocity  kinematics.  Even  though  the  RUM  arms  are  rotating,  they 
contribute  only  a  linear  velocity  term  to  the  kinetic  energy.  This  is  due  to  the  fact  that 
for  a  point  mass  model,  there  is  no  inertia  about  the  center  of  mass  and  the  rotation 
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occurs  about  a  point  other  than  the  center  of  mass.  These  modifications  result  in  a 
total  kinetic  energy  consisting  of  only  three  terms  as  described  in  Equation  (41). 

Kxotal  ~  K.3, Rotational  +  K4  jTransIational  K5^Translational  (41) 

There  is  one  drawback,  however,  to  these  modifications.  The  notation  used  in  Chapter 
3  is  no  longer  valid  and  considerable  care  must  be  taken  when  calculating  the 
manipulator  Jacobians.  A  systematic  approach  must  still  be  used  since  there  are 
intricate  kinematics  involved  primarily  because  of  the  complexity  of  the  RUM  motion 
in  reference  to  the  base  frame.  Appendix  B  shows  detailed  calculations  for  the  RUM 
system  Jacobians. 

4.2  Dynamic  Modiflcations 

The  kinematic  modifications  made  in  the  previous  sections  reduce  the 
complexity  of  calculating  the  system’s  kinetic  energy  and  allow  further  reductions  of 
the  dynamic  model  presented  in  this  section.  Although  the  specific  notation  used  in 
Chapter  3  is  no  longer  useful  because  of  the  modifications  necessary  for  modeling  the 
RUM  system,  the  basic  concepts  are  still  valid.  The  Lagrange  energy  function, 

requires  the  calculation  of  only  three  kinetic  energy  terms  since  potential 
energy  is  zero.  Applying  the  Euler-Lagrange  equation  discussed  in  Chapter  3, 
(repeated  here  in  Equation  (42)  below),  will  result  in  the  desired  equations  of  motion 
but  in  a  very  unstructured  form. 
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dtl  dq, 


dL(q,^,t) 

Sq, 


(42) 


The  results  of  Equation  (42),  require  significant  manipulation  to  separate  the  sixteen 
inertia  terms  and  sixteen  coriolis/centripetal  terms  into  a  form  similar  to  Equation  (43) 
(repeated  from  Chapter  3).  Note  there  are  no  gravitational  terms  in  the  RUM  system, 
since  potential  energies  cancel. 


Hm 

+  G{q)  =  F 

n 

n 

inertia 

coriolis/ 

gravity 

term 

centripetd 

term 

term 

The  form  presented  in  Equation  (43)  is  desirable  since  it  provides  considerable  insight 
into  model  validation  and  controllability  (discussed  in  Chapters  5  and  6).  A  more 
systematic  and  algorithmic  approach,  presented  by  Spong  and  Asada  [17,16],  takes 
advantage  of  the  relationship  between  the  kinetic  energy  coefficients,  the  inertia  terms, 
and  the  coriolis  /  centripetal  terms.  Recalling  that  the  Jacobians,  J,  and  the  rotation 
matrices,  R,  are  functions  of  the  joint  variables,  Equation  (44)  shows  the 
relationship  between  the  kinetic  energy  coefficients  and  the  inertia  matrix,  H{q) 
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/=i 


coefficient  matrix 

-  -K. 


1  N  N 

^  /=i  y=i 


(44) 


where;  h^j(q)  is  the  (i,j)  component  of  H(q).  There  are  four  independent  joint 
variables,  qi  through  q4  ,  corresponding  to  0j,  02,  04,  and  06  for  the  RUM  system. 
Therefore,  the  Jacobians,  J'^  and  J‘^ ,  are  3x  4  matrices,  resulting  in  a  4  x  4  coefficient 
matrbc  for  the  kinetic  energy  equal  to  the  H(q)  matrix.  Equation  (45)  shows  a  further 
relationship  between  the  inertia  matrix,  H(q) ,  and  the  coriolis  /  centripetal  matrix, 
[17] 


kj  -  2 


,=i  2  [  dq,  dqj 


(45) 


where;  Ckj  is  the  (k,j)  component  of  the  C{q,q)  matrix,  which  is  also  a  4  x  4  matrix 
for  the  RUM  system.  These  calculations  result  in  the  system  of  equations  in  the  form 
of  Equation  (46)  below.  Detailed  values  are  given  in  Appendix  C. 
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^11  ^12  ^13  ^14  ^1  ^11  ^12  ^13  ^14  ^1  ^1 

^21  ^22  ^23  ^24  ^2  _j_  ^21  ^22  ^23  *^24  ^2  _  ^2  (^^) 

^31  ^32  ^33  ^  ^3  ^31  ^32  ^  ^  ^3  ^3 

^41  ^42  ^  ^44_.^4_  _^41  ^42  ^  ^  _  .^4_  .^4_ 

where:  hy  is  a  function  of  ^  and  Ckj  is  a  function  of  ^and^.  Analysis  of  the 

components  of  the  H(q)  and  C{q,q)  matrices  reveal  certain  relationships  allowing 
further  simplifications.  The  H{(q)  matrix  is  symmetric  and,  due  to  system 
configuration,  hi3=hi4  and  h23=h24.  Therefore,  h3i=h4i  and  h32=h42.  System 
configuration  also  helps  simplify  the  C(^,^)  matrix  with  the  following  relationships; 
Ci3=ci4,  C23=C24,  C3i=C4i,  and  C32=C42.  Assuming  that  9^  =9^,6^=  6^,0^  =0^  (i.e. 
position  references,  velocities  and  accelerations  are  the  same  for  both  RUM  devices) 
and  noting  that  torque  is  applied  only  at  the  RUM  torque  motor.  Equation  (46)  reduces 
to  Equation  (47). 

^1  ^2  ^3  ^  ^2  ^3  4l  ^ 

^2  ^3  ^  ^1  ^2  4^  ~  0 

.^3  ^  ^3  _  %_  ^2  ^  _  %_  J3_ 


(47) 
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4.3  Summaty 

Efficient  modeling  of  the  RUM  actuated  system  requires  numerous 
modifications  to  the  standard  Lagrange  Formulation  presented  in  Chapter  3,  The 
modifications  void  the  standard  notation  used  in  Chapter  3  but  result  in  a  simplified 
model.  Directly  applying  the  Lagrange  Formulation  to  the  RUM  system  would  result 
in  six  equations  of  motion  with  only  three  degrees  of  freedom  present.  The 
modifications  presented  in  this  chapter  enable  a  reduction  of  system  order,  without 
loss  of  system  details,  resulting  in  three  equations  of  motion  for  the  system  model. 
The  approach  taken  in  this  chapter,  however,  is  unconventional  in  robotic  applications. 
Therefore,  it  is  critical  to  validate  the  model  to  ensure  that  the  modifications  were 
accomplished  correctly.  Chapter  5  discusses  this  validation  using  several  different 


methods. 


CHAPTER  5 


MODEL  VALIDATION 

The  modeling  approach  described  in  Chapter  4  borrows  from  robotic  modeling 
methods,  but  is  unconventional  in  a  robotic  modeling  sense.  Therefore,  it  is  necessary 
to  validate  the  model.  Analytic  analysis,  simulation  tools  (including  Maple™  and 
Matlab™),  and  experiments  provide  model  validation.  This  chapter  discusses 
kinematic  model  validation  and  dynamic  model  validation. 

5.1  Kinematic  Model  Validation 

Validation  of  the  kinematic  model  is  critical  to  subsequent  development  of  the 
dynamic  equations  of  motions.  Kinematics  errors  will  result  in  errors  in  the  model 
dynamics  due  to  misrepresentation  of  the  system  configuration.  Matlab™  simulation 
results,  shown  in  Figure  27a.  -  Id,  validate  the  kinematic  equations  for  the  following 
parameters;  RUM  radius  (r)  =  0.5  feet,  distances  between  telescope  gimbal  and  RUMs 
(d)  =2.5  feet.  A  different  joint  variable  is  put  into  motion  for  each  simulation.  The 
patterns  traced  indicate  the  end  position  of  the  mass  of  each  RUM.  Comparison  of 
these  simulations  to  analytical  solutions  confirms  that  the  kinematic  model  is  correct. 
This  validation  helped  identify  and  correct  a  configuration  error  in  the  orientation  of 
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the  telescope  resulting  in  the  02  +  90°  term  for  the  joint  2  parameters  seen  in  Table  2  of 
Chapter  4. 


a.  Elev  and  X-Elev  axis  motion  w/out  RUM  b.  X-Elev  axis  motion  w/  RUM  motion 
motion 


c.  Elev  axis  motion  w/  RUM  motion  d.  Elev  and  X-Elev  axis  motion  w/RUM 

motion 


Figure  27  Kinematic  Simulations 


5.2  Dynamic  Model  Validation 

The  dynamic  model  is  validated  in  several  steps  detailed  in  the  following 
subsections.  An  anal3dic  validation  is  accomplished  by  first  applying  the  Lagrange 
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Formulation  to  a  simple,  known,  mechanical  system  to  ensure  the  approach  is  valid  for 
a  known  system  and  to  gain  insight  into  application  to  the  RUM  actuated  system. 
Then,  the  RUM  system  inertia  and  the  coriolis/centripetal  matrices  are  investigated  to 
ensure  they  have  the  proper  form.  Next,  the  RUM  model  developed  in  Chapter  4  is 
compared  to  other  models  presented  in  Chapter  2.  Finally,  an  experimental  validation 
is  accomplished  by  comparing  the  experimental  results  with  the  Matlab™  simulations 
of  the  system  in  the  different  modes  of  operation  (i.e.  scanning  and  pointing). 

5.2.1  Pendulum  Example 

The  first  validation  uses  a  robotics  approach  to  apply  the  Lagrange 
Formulation  to  a  simple,  known,  mechanical  system  to  confirm  the  validity  of  its  use 
and  provides  some  understanding  into  how  to  apply  it  to  more  complex  systems.  The 
kinetic  energy  calculations  of  a  pendulum  system  can  help  identify  errors  in  the  RUM 
model.  A  simple  pendulum  system,  shown  in  Figure  28,  is  used  to  validate  the 
approach. 
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The  pendulum  has  a  known  equation  of  motion  [18]  given  by  Equation  (48). 


ma^O  +  mga  sin  9  =  -k9  (48) 

or 

ma^9  -{■k9  +  mga  sm9  =  0 

where:  k9  is  the  generalized  friction  torque  at  the  joint. 

Applying  the  Lagrange  Formulation  to  the  pendulum  system  results  in  the 
same  equation  of  motion.  The  process  of  modeling  the  pendulum  gives  considerable 
insight  into  application  of  the  Lagrange  Formulation  to  the  RUM  actuated  system.  The 
link  of  the  pendulum  system  is  similar  to  the  link  of  the  telescope  system  containing 
the  RUM  mass.  Each  is  modeled  as  a  point  mass  with  center  of  mass  at  the  end  of  the 
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link  arm.  Since  the  links  are  modeled  as  point  masses,  the  inertia  about  the  center  of 
mass  of  each  link  is  zero.  Therefore,  the  kinetic  energy  will  only  have  a  tran.slatinnal 
component  and  not  a  rotational  component.  This  is  an  important  discovery  that  can 
help  identify  inertia  errors  in  the  RUM  model. 


5.2.2  Verifying  Matrix  Properties 

Certain  properties  of  the  inertia  and  coriolis/centripetal  matrices  can  also  be 
used  as  analytical  tools  to  validate  the  model.  The  inertia  matrix,  H,  will  be 
symmetric  if  the  modeling  process  is  performed  properly  [17].  Results  from  Chapter  4 
indicate  that  the  4x4  H  matrix  (before  the  model  reduction)  is  symmetric  for  the  RUM 
system.  In  fact,  this  symmetry  is  one  of  several  properties  used  to  reduce  the  order  of 
the  model.  Further  investigation  of  the  H  matrix  and  the  coriolis/centripetal  matrix,  C, 

is  performed  by  investigating  the  properties  of  N(q,q)  defined  in  Equation  (49). 


m,b  =  H{q)-2C{q,q) 


(49) 

If  the  calculations  for  C  and  H  are  correct,  N(q,q)  will  be  skew  symmetric.  That  is, 
rijk  ofV  satisfies  %  =  -  %.  The  proof  of  this  property  is  given  in  [17].  Calculating 
for  the  RUM  actuated  system  results  in  a  skew  symmetric  matrix. 
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5.2.3  Model  Analysis 

Two  models  are  available  for  comparison  with  the  model  developed  in  Chapter 
4.  These  models  have  certain  limitations  and  assumptions  associated  with  their 
development.  The  purpose  of  this  section  is  to  determine  if  the  model  developed  in 
Chapter  4  yields  the  simple  models  under  the  same  assumptions.  The  next  subsections 
briefly  describe  the  different  models,  including  their  attributes  and  limitations, 
followed  by  an  analytical  comparison  of  each  model. 

5.2.3.1  Model  Descriptions 

The  models  described  in  this  section  are  the  equations  of  motion  developed 
using  the  different  modeling  techniques  employed  in  Chapter  2  and  Chapter  4.  Model 
1,  repeated  here  in  Equation  (50),  was  developed  in  Chapter  2  assuming  a  constant 
speed  RUM  and  treats  the  RUM  as  an  actuator  independent  of  telescope  dynamics. 


*^LOS 

0 

=  2mrd 

4 

r^elcos{9^) 

(50) 


The  attributes  of  Model  1  include: 

1 .  Simplicity  permits  a  closed  form  solution. 

2.  Elevation  and  cross-elevation  axes  are  not  coupled. 

3.  RUM  arm  is  coupled  to  the  telescope  only  through  the  centripetal  terms. 
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4.  Constant  RUM  speed  is  assumed. 

5.  Small  angular  displacement  in  the  elevation  and  cross-elevation  axes  is  assumed. 
Since  Model  1  does  not  account  for  variations  in  the  RUM  speed,  Model  2  was 
developed  in  Chapter  2  assuming  a  variable  speed  RUM  and  is  repeated  here  in 
Equation  (51). 


^LOS 

0 

On 

=  2mrd 

Ir  sin(^^  )  +  cos(0^ )] 

_  ^ X  cos(^^ )  sin(^^  )]  ^ 

n  n 

centripetal  reaction 

components  components 

The  attributes  of  Model  2  include: 

1 .  Model  2  is  slightly  more  complex  than  Model  1  but  still  fairly  simple. 

2.  Elevation  and  cross-elevation  axes  are  not  coupled. 

3.  RUM  arm  is  coupled  to  the  telescope  only  through  the  centripetal  terms  and 
reaction  terms. 

4.  Variable  RUM  speed  is  assumed. 

5.  Small  angular  displacement  in  the  elevation  and  cross-elevation  axes  is  assumed. 
Model  3  is  the  reduced  order,  detailed  model  developed  in  Chapter  4.  It  has  equations 
of  motion  shown  in  Equation  (52)  where  hy  and  Cy  are  as  previously  defined  in 
Chapter  4  and  Appendix  C. 


76 


K\  hi  ^3 

'4' 

'O' 

hi  hi  ^3 

+ 

^2  ^23 

4 

0 

hi  hi  hi  _ 

^32  0 

4_ 

3. 

(52) 


Equation  (52)  must  be  put  into  a  form  similar  to  Equations  (50)  and  (51)  using  the 
equations  of  motion  for  the  line  of  sight,  elevation  and  cross-elevation  axes  to  allow 
for  comparison  of  the  models.  From  the  model  developed  in  Chapter  4,  q\  represents 
9x,  qi  represents  $£,,  and  qz  represents  Or..  The  line-of-sight  angular  motion  is 
physically  constrained  to  zero  by  the  gimbal  mount,  allowing  the  equations  of  motion 
for  the  line  of  sight,  elevation  and  cross-elevation  axes  for  Model  3  to  be  written  as 
shown  in  Equation  (53). 


^LOS 

0 

Oe 

^2  ^  '^hl^R  “  “  ^ll^E  ”  2^23^)i?) 

1 

_ 1 

_  hi  ^hl^E  ^'^hl^R  ^^ll^E 

The  Model  3  attributes  include: 

1.  Model  3  is  a  detailed  model  involving  complicated,  nonlinear  terms. 

2.  Shows  coupling  between  the  elevation  and  cross-elevation  axes. 

3.  Shows  coupling  of  the  telescope  with  the  RUM  arm  through  inertia  terms  and 
coriolis/centripetal  terms. 

4.  No  assumptions  made  about  RUM  speed;  valid  for  all  operating  conditions. 

5.  Also  provides  an  equation  of  motion  for  the  RUM  link  (i.e.  Oj^ )  when  in  the  form 
of  Equation  (52). 
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5.2.3.2  Model  Comparisons 

The  models  developed  in  Chapter  2  and  described  in  the  previous  section  contain 
only  the  equations  of  motion  {eoni)  for  the  line  of  sight,  elevation,  and  cross-elevation 
axes  of  the  RUM  actuated  telescope.  Model  analysis  is  accomplished  by  comparing 
the  line  of  sight  axis  eom,  elevation  axis  eom,  and  the  cross-elevation  axis  eom 
between  models.  An  analytic  comparison  of  the  models  reveals  that  under  certain 
assumptions,  the  model  developed  in  Chapter  4  (Model  3)  reduces  to  Model  1  and 
Model  2.  Reducing  Model  3  to  Model  2  requires  the  following  assumptions: 

1.  No  cross-coupling  in  the  inertias  of  the  elevation  and  cross-elevation  telescope 
axes.  The  RUM  is  coupled  to  the  telescope  inertias  only  through  the  his  and  hss 
terms. 

Result:  Inertia  matrix  has  constant  diagonal  elements  and  two,  time  varying,  off 
diagonal  elements. 

2.  Zero  telescope  centripetal  and  coriolis  effects.  Also,  zero  coriolis  effects  between 
telescope  and  RUM  axes.  The  only  effects  retained  in  the  model  are  the  RUM 
centripetal  terms. 

Result:  All  C-matrix  elements  are  zero,  except  for  cis  and  C23  in  Equation  (53). 

3.  Let  6e  be  small,  so  cos(^)  =  1  and  sin(6fe)  =  0. 

Result:  Equation  (54),  which  is  the  Model  2  with  a  few  minor  differences. 
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^LOS 

0 

=  Imrd 

IeVOI  sin(<9j, )  -  4  cos(<9^ )] 

A. 

+  IxV-Ol  cos(^«)  -  4  sin(^«)] 

Note  that  the  terms  in  Equation  (54)  are  shifted  180  degrees  from  the  terms  in 
Model  2  shown  in  Equation  (51).  Since  the  choice  of  reference  frame  changes  all 
the  relationships  by  180  degrees,  the  corn’s  are  not  altered  by  the  difference  in 
frame  selection.  Therefore,  the  results  show  that  Model  3  contains  the  reaction 
force  model. 

Reducing  Model  3  to  Model  1  requires  the  same  three  assumptions  listed  previously 
plus  an  additional  assumption: 

4.  Constant  RUM  speed.  The  (RUM  acceleration)  is  zero  and  4  (RUM  velocity) 
is  constant. 

Result:  Equation  (55),  which  is  Model  1  with  terms  shifted  180  degrees  similar  to 
Model  2. 


^LOS 

0 

4 

=  Imrd 

/^‘4sin(6>^) 

A. 

—  I X  Or  COS(0r)_ 

Therefore,  the  results  show  that  Model  3  contains  Model  1  as  well. 


(55) 


5.2.4  Experimental  Validation 

Experimental  validation  is  performed  by  comparing  Matlab™  simulation 
results  with  the  actual  NASA  test  system  experimental  results.  Numerous  tests  were 
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conducted  on  the  NASA  experiment  and  documented  in  [19],  There  is  an  important 
distinction  between  these  tests  and  those  reported  earlier  by  Polites  [3,20],  Earlier 
tests  confirmed  accurate  scanning  and  pointing  performance  when  auxiliary  gimbal 
control  actuators  and  closed-loop  gimbal  control  are  employed.  The  tests  described 
here  are  conducted  without  gimbal  control  thus  evaluating  the  open-loop  response  of 
the  system.  Since  the  goal  of  the  present  testing  is  to  validate  a  new  model  of  the 
open-loop  system  dynamics,  these  test  results  cannot  be  compared  to  the  findings 
reported  earlier.  This  section  describes  how  the  simulations  were  accomplished  by 
introducing  different  representations  for  Models  1  and  2.  This  section  also  compares 
simulation  results  with  experimental  results  under  different  modes  of  operation 
including  a  constant  RUM  speed  mode  of  operation,  start-up  transient  response,  and  a 
variable  RUM  speed  mode  of  operation. 

5.2.4. 1  Model  Form 

Putting  Model  3  into  a  robotics  framework  helps  identify  the  input  to  the  RUM 
torque  motors  necessary  for  different  operating  modes.  The  models  are  put  into  the 

same  format,  namely  H(q)q  +  C(q,q)q  =  r ,  to  facilitate  simulation.  The  control 
input  is  through  the  x  term,  which  is  the  input  torque  vector  to  the  different  joints. 
This  is  significantly  different  than  Polites’  original  model  in  which  he  used  a  torque 
input  about  the  elevation  and  cross-elevation  axes  generated  by  the  centripetal  force  of 
the  RUM.  In  the  above  form,  however,  the  torque  input  to  the  RUM  actuated  system 
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is  7-  =  [0  0  Tjf  showing  that  the  cross-elevation  and  elevation  joints  are  unactuated 

(i.e.  Ti  and  T2  are  zero).  T3  controls  the  speed  of  the  RUM  arms  through  input  torque 
to  the  RUM  torque  motors.  Equation  (52)  shows  Model  3  already  in  this  form.  Since 
Model  1  and  Model  2  are  contained  in  Model  3,  they  can  easily  be  put  into  this  same 
form  as  shown  below  in  Equation  (56)  and  (57).  Note  that  these  equations  are  shifted 
by  180  degrees  to  permit  comparison  with  Model  3. 


■4 

0 

0 

’^1’ 

"0 

0 

2(mrdq^sm(qJ) 

'O' 

0 

4 

0 

0 

0 

2{mrdq^cos(q^)) 
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4  0  -2mrdcos(q^) 

’4^1' 

0  0  2j(mrdq^  sin  (q^)) 

’o' 

0  7^  2mrd  sin  (q^) 

+ 

0  0  2j(mrdq^  cos(q^)) 

^2 

= 

0 

.  ®  ^  4ujv 

.^3. 

0  0  0 

In  this  form,  both  models  contain  an  equation  of  motion  for  the  RUM  arm.  This  gives 
the  designer  considerable  insight  into  how  to  apply  the  desired  torque  to  the  RUM 
arm.  This  form  also  gives  model  flexibility  by  allowing  friction  or  disturbances  at  the 
different  joints  through  the  torque  inputs  (ti,  T2,  ts). 
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5.2.4.2  Matlab™  Simulations 

In  the  Matlab  simulations,  the  equations  of  motion  are  numerically 
integrated  to  solve  for  ^  and  e-  A  numerical  integration  is  required  for  the  detailed 
model  because  of  the  complexity  of  C,  H  and  ET^  and  the  lack  of  a  closed  form 
solution  for  q .  Model  1  and  Model  2  are  simulated  using  the  same  techniques  to 
ensure  that  differences  in  numerical  techniques  do  not  contribute  to  differences  in  the 
simulations.  Matlab™  contains  numerous  numerical  integration  procedures  called 
ordinary  differential  equations  (ODE)  solvers.  They  are  intended  to  solve  a  general 
system  of  differential  equations  of  the  form  y  =  f(t,y),  where  t  is  the  scalar 
independent  variable  and  >/  =  y(t)  is  the  vector  of  dependent  variables.  This  ODE 
solver  is  based  on  the  classic  Runge  -  Kutta  method  [21].  This  method  treats/{?,^;  as  a 
function  of  two  independent  variables,  samples  the  function  for  several  different 
values  of  these  variables,  combines  the  samples  to  approximate  the  Taylor  series,  and 
integrates  the  resulting  approximation  over  one  time  step.  ODE  45  is  used  in  the 
RUM  system  simulations.  The  digits  4  and  5  refer  to  the  order  of  the  underlying 
method.  ODE  45  employs  two  approximations,  one  of  order  4  and  one  of  order  5,  and 
uses  their  difference  to  estimate  the  error  in  each  step.  The  order  is  roughly  the 
number  of  terms  in  the  Taylor  series  approximation. 

To  put  the  RUM  actuated  system  into  ‘first  order’  form  consistent  with 
y-f(f^y),  the  six  state  variables  are  defined  as: 


X,  =  (elev  postion) 


^4  =  velocity) 


^2  “  ^2  (x-elev  position)  (x-elev  velocity) 

X3  =  q3  (RUM  position)  (RUM  velocity) 

The  resulting  ‘first  order’  differential  equation  is  shown  in  Equation  (58): 


X  = 


^3x3 

^3x3 

®3*3 

_^3x3 

-H-^C 

H-' 

L  _ 

r 


(58) 


where;  H  and  C  were  previously  defined  in  the  Chapter  4  calculations.  The  control 
input,  T,  is  the  single  torque  input  to  the  RUM  torque  motors.  The  Matlab™ 
simulations  use  several  M-files  containing  RUM  system  parameters.  Figure  29  shows 
the  flow  diagram  for  the  simulations. 
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Figure  29  Flow  Diagram  for  RUM  Simulations 
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The  system  parameters  used  for  the  RUM  actuated  system  simulation  are  specified 
below  and  are  consistent  with  the  test  configuration  shown  in  Chapter  2. 
m  =  .155  slugs 
d  =  2.5  feet 
r  =  0.5  feet 

I  (telescope  along  X  axis)  =  I  (telescope  along  y  axis)  =  26  slug  -  (specified  in  reference  frame  2) 

Note  that  this  numerical  integration  technique  was  successfully  tested  on  the  simple 
pendulum  system  to  validate  its  use  for  the  RUM  system. 

5.2.4.3  Constant  RUM  Speed  Analysis 

Polites’  analysis  in  Chapter  2  and  [3,20]  indicates  that  a  constant  RUM  speed 
should  generate  a  circular  scanning  motion.  Constant  RUM  speed  is  implemented 
using  a  RUM  torque  command  based  on  velocity  feedback.  Proportional  control  is 
used  to  generate  the  commanded  torque  given  in  Equation  (59). 

^3  =  proportional gain(Velocity3,„^.,^_„  -  Velocity^^^^,.,^,,)  (59) 

=  (constant -^3) 

This  torque  is  generated  in  the  Matlab™  thetadot.m  program.  The  initial  conditions 
are  based  on  the  assumption  that  the  system  is  in  the  steady  state  scanning  mode 
already.  That  is,  the  RUM  is  rotating  at  a  constant  speed  and  the  telescope  is 
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scanning.  For  a  RUM  reference  speed  of  k  rad/sec  and  RUM  position  (qs)  of  0 
radians,  the  initial  conditions  are: 


=  ki 


^0,2  •^0,3  ^0,4 


0,5  ^0,6  r 


-  2mrd  ^  Imrd 
0  -  0  - n  0  n 


-\T 


(60) 


Figure  30  shows  a  comparison  between  the  experiment  and  simulation  results  for  each 
of  the  models.  Note  that  the  initial  offset  bias  is  removed  from  the  experimental  data. 


a.  Actual  Experiment 


b.  Model  1 
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c.  Model  2 


x-elev  pos  (rad) 


d.  Model  3 


Figure  30  Constant  RUM  Velocity  Simulation  Results 

Observations: 

1 .  Scanning  is  a  “steady  state”  mode. 

2.  The  experiment  radius  of  the  scan  is  .01 5  radians  with  a  period  of  2  sec. 

3.  There  are  some  unmodeled  disturbances  in  the  experiment  observed  by  the 
fluctuations  in  the  scan  pattern.  There  are  a  number  of  possible  sources  for  the 
disturbances  including  imbalances  in  the  system,  control  cable  interference, 
friction,  etc. 

4.  All  3  models  closely  approximate  the  experiment  in  the  scanning  mode  with  a 
radius  of  approximately  0.015  radians  and  a  2  second  scan  period. 

5.2.4.4  Start-Up  Transient  Behavior. 

The  start-up  transient  response  simulation  is  conducted  with  all  initial 

conditions  set  to  zero  (i.e.  the  system  is  at  rest).  Torque  is  then  applied  to  the  RUM 
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actuator  to  accelerate  to  and  maintain  a  constant  speed  of  n  rad/sec.  The  simulation 
results  are  compared  to  the  experimental  results  in  Figure  3 1 . 


Experimantal  Data 


x>e]e¥  pos  (rad] 


Elevation  poshionvs  X-Eievation  position 


a.  Actual  Experiment 


b.  Model  1 


x-elBV  pos  (rad) 


c.  Model  2 


Elevation  poshionvs  X-Elevalion  position 


d.  Models 


Figure  31  Start-Up  Transient  Response  Simulation  Results 

Observations: 

1.  The  experiment  shows  small  fluctuations  in  the  transient  response  presumably 
caused  by  the  synchronization  of  the  RUM  arms  to  the  180°  spatial  displacement 
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position.  After  the  fluctuations  settle  out,  a  fairly  constant  steady  state  scan  is 
observed  with  no  significant  offset. 

2.  Model  1  shows  significant  errors  in  the  transient  behavior  of  the  model  compared 
to  the  experimental  results.  It  shows  a  large  offset  in  both  the  elevation  and  cross¬ 
elevation  axis. 

3 .  Models  2  and  3  show  similar  results  observed  on  the  experiment. 

5.2.4.5  Variable  RUM  Speed  Analysis. 

This  section  investigates  the  behavior  of  the  experiment  and  all  three  models 
when  a  variable  RUM  speed  is  introduced  to  the  system.  A  variable  RUM  speed  can 
be  generated  by  adjusting  the  RUM  joint  torque  input  (13).  Equation  (61)  shows  one 
such  possibility  for  varying  the  RUM  speed. 

%(rcn  =  nominal  speed  +  ~  cos(^3  +  ^) 

^3  = 


Where  A  is  the  change  in  maximum  to  minimum  RUM  speed  and  (|)  is  a  phase  shift 
term  used  to  adjust  the  location  of  RUM  acceleration  and  deceleration  in  each 
revolution.  Applying  the  torque  in  this  manner  generates  a  RUM  velocity  profile 
shown  in  Figure  32.  Note  that  the  nominal  speed  is  %  rad/sec  and  ^  =  %/4. 
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nominal 
speed 
(t:  rad/sec) 


time  plot  polar  plot  of 

Figure  32  RUM  Velocity  Profile 


Viewing  the  velocity  profile  on  a  polar  plot  in  Figure  32  reveals  where  the  RUM  is 
accelerating  and  decelerating  in  each  revolution.  Note  that  since  there  is  no  feedback 
from  the  elevation  and  cross-elevation  axes  present  in  X3,  these  simulations  address  the 
open  loop  behavior  of  the  system.  The  results  of  applying  this  torque  to  the 
experiment  and  models  are  shown  in  Figure  33.  Note  that  A  =  0.1  for  the  Model  1 
simulation  and  A  =  1.0  for  the  other  simulations.  The  larger  A  is  used  to  determine  if 
a  larger  velocity  change  may  increase  the  offset  in  the  elevation  and/or  cross-elevation 


axes. 
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d.  Model  3 


Figure  33  Variable  RUM  Velocity  Simulation  Results 

Observations; 

1.  The  control  input  from  Equation  (61)  alone  has  little  noticeable  effect  on  the 
experimental  systems  pointing  motion.  That  is,  significant  changes  in  the  average 
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cross-elevation  and  elevation  angles  are  not  possible  using  the  control  input  (61) 
alone. 

2.  Model  1  predicts  significant  effects  on  the  instrument  pointing  motion  by  using  the 

control  input  (61)  alone.  It  shows  a  large  offset  in  both  the  elevation  and  cross¬ 
elevation  axis. 

3.  The  reaction  force  model  predicts  no  noticeable  effect  on  the  instrument  pointing 
hy  using  control  input  (61)  alone.  Even  the  larger  A  has  no  noticeable  effect. 

4.  The  detailed  model  predicts  a  very  small,  long  term  effect  on  the  pointing  angles. 
The  detailed  model  is  in  agreement  with  the  behavior  observed  in  the  experimental 
system.  The  predicted  effect  is  small,  however,  and  may  be  easily  washed  out  by 
imperfections  in  the  actual  experiment  (e  g.  nonlinear  friction  at  the  gimbals, 
gravity,  cable  tensions,  etc  ).  Again,  the  larger  A  has  no  significant  effect. 

5.  Even  though  Model  1  does  not  agree  with  either  the  experiment  or  the  other  two 
models,  it  does  give  insight  to  how  instrument  pointing  can  be  achieved  by  a 
modified  control.  In  other  words,  the  control  input  (61)  may  not  be  suitable  alone, 
but  may  be  effective  if  augmented  by  other  control  effort.  This  is  explained 
further  in  Chapter  6. 

5.3  Summary 

Validation  of  the  RUM  actuated  system  model  involves  several  techniques.  Since  all 

of  the  dynamics  depend  on  the  position  and  velocity  of  each  component,  the 

kinematics  of  the  system  must  be  validated  to  ensure  proper  system  configuration. 
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The  data  presented  in  this  chapter  has  validated  the  dynamic  model  analytically  and 
experimentally.  Further,  the  dynamic  model  is  shown  to  contain  the  simple  models 
and  does  not  contradict  the  experimental  results. 


CHAPTER  6 


FEASIBILITY  OF  RUM  ACTUATED  POINTING  CONTROL 

A  detailed  model  is  very  important  when  considering  the  control  of  the  RUM- 
actuated  system.  The  difference  between  the  models  is  significant.  Model  1  and 
Model  2  have  limited  use  in  pointing  control  design  since  they  do  not  consider  large 
angular  motion  in  the  elevation  and  cross-elevation  axes  which  is  the  goal  for  the 
pointing  control  schemes.  They  also  neglect  coupling  between  the  elevation  axis  and 
the  cross-elevation  axis  and  some  coupling  between  the  RUM  arm  and  these  axes. 
Knowledge  of  this  coupling  may  be  essential  when  considering  a  control  scheme 
because  of  the  limited  number  of  actuators  in  the  system.  Therefore,  the  model 
developed  in  Chapter  4  and  validated  in  Chapter  5  is  necessary  when  investigating 
pointing  control  schemes.  Models  1  and  2,  however,  can  lend  insight  into  the 
controllability  of  the  RUM  actuated  system.  In  this  chapter,  the  feasibility  of  RUM 
actuated  pointing  is  examined  by  analyzing  the  open  loop  response  of  the  system  to 
different  control  inputs.  Open  loop  response  here  means  no  cross-elevation  or 
elevation  motion  information  is  used  for  the  feedback  control.  Figure  34  shows  the 
general  control  scheme  used  in  this  chapter.  Note  that  the  RUM  motion  is  used  for 
feedback  control  of  the  RUM  velocity  only. 
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coupling 


Figure  34  General  Open-Loop  Control  Scheme 

Several  different  control  schemes  are  investigated  for  pointing  actuation  using 
the  RUM  devices.  Pointing  control  using  simple  RUM  rate  variations  is  examined 
first,  followed  by  feedback  ‘cancellation’  analysis.  Next,  since  these  two  control 
schemes  raise  issues  regarding  the  controllability  of  the  system,  system  controllability 
(or  reachability)  and  a  coupling  index  are  discussed.  Finally,  variable  gimbal  braking 
and  variable  RUM  arm  length  are  considered  as  possible  additions  to  the  pointing 
control  configurations  and  schemes. 
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6. 1  Pointing  Control  Using  RUM  Rate  Variations 

In  this  section,  Polites’  control  scheme  presented  in  Chapter  2  is  investigated. 
Polites  proposed  to  use  a  control  signal  that  introduces  periodic  variations  in  the  RUM 
rate,  Or.  The  suggested  control  input  is  repeated  here  in  Equation  (62). 

~  cos(^^  )  -  Ao)^  sin(^g  )  ^^2) 

where: 

(Oro  :  a  constant  (nominal  RUM  rate  of  rotation) 

:  a  rate  variation  to  compensate  for  cross-elevation  gimbal  error 
^coe  :  a  rate  variation  to  compensate  for  elevation  gimbal  error 
Recall  that  the  sine  and  cosine  terms  in  Equation  (62)  weight  the  rate  variations  to  give 
them  the  proper  ‘timing’.  In  Chapter  2,  this  control  scheme  was  implemented  in  a 
disturbance  rejection  test.  Here,  the  control  scheme  is  applied  to  Model  3  (full  model) 
and  is  used  to  determine  the  feasibility  of  pointing  control.  The  variable  RUM  speed 
analysis  conducted  in  the  Chapter  5  investigates  this  type  of  control  input  for  constant 
rate  variations  {Acox  and  An^).  Note  that  since  there  is  no  feedback  from  the  elevation 
and  cross-elevation  axes,  these  studies  address  the  open  loop  behavior  of  the  system. 
The  following  conclusions  can  be  drawn; 

1.  The  control  input  from  Equation  (62)  alone  has  little  noticeable  effect  on  the 
experimental  systems  pointing  motion.  That  is,  significant  changes  in  the  average 
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cross-elevation  and  elevation  angles  are  not  possible  using  the  control  input  (62) 
alone. 

2.  Model  1  predicts  significant  effects  on  the  instrument  pointing  motion  by  using  the 
control  input  (62)  alone. 

3.  Model  2  predicts  no  noticeable  effect  on  the  instrument  pointing  by  using  control 
input  (62)  alone. 

4.  Model  3  predicts  a  very  small,  long  term  effect  on  the  pointing  angles.  Model  3  is 
in  agreement  with  the  behavior  observed  in  the  experimental  system.  The 
predicted  effect  is  small,  however,  and  may  be  easily  washed  out  by  imperfections 
in  the  actual  experiment  (e.g.  nonlinear  friction  at  the  gimbals,  gravity,  cable 
tensions,  etc.). 

5.  Even  though  Model  1  does  not  agree  with  either  the  experiment  or  the  other  two 
models,  it  does  give  insight  to  how  instrument  pointing  can  be  achieved  by  a 
modified  control.  In  other  words,  the  control  (62)  may  not  be  suitable  alone,  but 
may  be  effective  if  augmented  by  other  control  effort.  This  is  explained  further  in 
the  next  section. 

6.2  Pointing  Control  using  Feedback  ‘Cancellation* 

Analysis  of  the  Model  1  suggests  that  pointing  control  of  the  system  should  be 
possible  if  the  undesirable  dynamic  effects  of  the  RUM  acceleration  and  deceleration 
can  be  cancelled.  The  more  detailed  models  2  and  3  indicate  that  cross-coupling  and 
other  nonlinear  dynamics  are  significant  and  cannot  be  ignored.  From  the  controller 
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design  viewpoint,  it  is  suggested  that  these  nonlinear  effects  be  cancelled  by  feedback 
control  [19],  The  idea  is  very  similar  to  feedback  linearizing  control,  which  has  been 
proven  in  robotics  control  (but  called  “computed  torque  control”)  to  give  linear 
closed-loop  dynamics  to  systems  that  are  inherently  nonlinear  [17],  In  the  RUM 
application,  however,  closed-loop  dynamics  consistent  with  that  predicted  by  the 
nonlinear  Model  1  is  the  goal,  rather  than  linear  closed-loop  dynamics.  From  the 
previous  variable  RUM  speed  analysis,  reaction  forces  can  be  identified  that  prevent 
pointing  from  happening.  When  the  reaction  terms  are  taken  out,  pointing  is  possible 
as  shown  in  Figure  35. 


Elevation  position  vs  X-Elevation  position 


Figure  35  Variable  Speed  Control  on  Model  3  without  Reaction  Forces 
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In  order  to  accomplish  this  feedback  cancellation  a  significant  amount  of  cross¬ 
coupling  must  be  present  since  the  system  is  under-actuated.  That  is,  the  system  has 
more  joints  (and  degrees  of  freedom)  than  actuators.  The  RUM  actuated  system  has 
three  degrees  of  freedom  and  a  single  actuator  since  the  RUMs  are  held  at  180°  spatial 
displacement.  The  restriction  on  the  RUM  phasing  ties  their  motion  together  and 
causes  them  to  become  a  single  actuator.  Dynamic  coupling  between  the  RUM  arm 
and  the  telescope  is  necessary  for  the  single  actuator  to  affect  motion  about  the 
elevation  and  cross-elevation  axes.  This  requires  the  determination  of  system 
controllability,  discussed  in  the  next  several  sections. 

6.3  Controllability  Analysis  Tools. 

A  system  is  said  to  be  controllable  at  time  to  if  it  is  possible  to  transfer  the 
system,  with  some  control  ‘m  ’,  from  any  initial  state  x(/o)to  any  other  state  3c(/.)in  a 
finite  interval  of  time  [22].  This  section  provides  several  valuable  tools  used  in  the 
determination  of  system  controllability.  To  lay  the  foundation  for  controllability  of 
the  non-linear  RUM  system,  a  linear  system  analogy  is  described  first.  Then,  non¬ 
linear  system  controllability  is  discussed,  followed  by  the  development  of  a  coupling 
index  used  for  under-actuated  system  analysis. 

6.3.1  Linear  System  Control  Analogy 

Consider  the  linear  system  model  given  by  Equation  (63). 
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X  =  Ax  +  Bu 
where:  x  =nx\  state  vector 

u  =mx  \  control  vector 
A=nxn  system  matrix 
B  =  nxm  input  matrix 


(63) 


The  system  is  said  to  be  completely  state  controllable  if  every  state  is  controllable. 
The  states  of  the  RUM  actuated  system  are  the  position  and  velocity  of  each  joint 
variable  as  discussed  in  Section  0  to  follow.  Every  state  is  controllable  if  and  only  if 
the  «  X  «  controllability  matrix  given  by  Equation  (64)  has  rank  n  [22, 24]. 

AB  •••  A^-^b] 


6.3.2  Nonlinear  System  Controllability  (Reachability) 

Consider  the  non-linear  system  model  given  by  Equation  (65). 


x  =  f(.x)  +  g(x)u 
where;  x  =  n  x  1  state  vector 


(65) 


M  =  m  X  1  control  vector 
/ (x)  and  g(x)  =  vector  functions  of  the  states 

The  ‘controllability  condition’  of  Equation  (65)  is  given  by  the  linear  independence  of 
the  vectors  in  Equation  (66)  similar  to  the  linear  systems  described  previously  [13]. 


100 


1^,  ad^g,  ad}-^g\ 

where: 

‘>d,g  =  U,g\  =  '^gf-Vg 
<-d‘,g=UM;'g\ 

V/  =  ^  jdx  (wjcwmatrix) 

Vg^dgjdx  (wjf«matrix) 

IXg]  is  known  as  the  Lie  Bracket  of /  and  g.  Note  that  for  linear  systems.  Equation 
(66)  becomes  the  controllability  matrix  [s  AB  ••• 

6.3.3  Coupling  index 

Using  the  Lagrange  Formulation  (i.e.H(q)q  +  C(q,q)q  +  G(q)  =  T)  for  the 

RUM  actuated  system  facilitates  the  use  of  numerous  robotic  analysis  techniques. 
One  technique  that  is  particularly  useful  for  control  analysis  is  the  coupling  index 
developed  by  Bergerman,  Lee,  and  Xu  [23],  The  coupling  index  is  a  measure  of 
dynamic  coupling  present  in  under-actuated  systems.  Under-actuated  refers  to 
systems  that  have  more  joints  than  control  actuators.  Some  examples  of  under¬ 
actuated  systems  are  robots  with  failed  actuators,  legged  robots  with  passive  joints 
and  hyper-redundant  (snake  like)  robots  with  passive  joints.  This  tool  will  provide 
insight  into  the  coupling  available  for  control  and  help  determine  system 
controllability.  This  section  briefly  explains  the  indexing  process  and  its  use  for 
determining  controllability  of  a  nonlinear  system. 
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To  use  the  coupling  index  technique,  the  system  equations  of  motion  must  be 
put  into  a  form  that  reveals  the  relationship  between  active  and  passive  joints. 
Equation  (67)  provides  this  relationship  for  a  system  with: 
n  =  total  number  of  joints, 
r  =  number  of  active  joints  (joints  with  actuation), 
p  =  number  of  passive  joints. 


Where:  qa  =  active  joint  angles 
qp  =  passive  joint  angles 
b  =  Coriolis,  centripetal,  and  gravitational  terms 
Note  that  this  H  matrix  may  not  always  equal  the  conventional  inertia  matrix  but  the 
properties  are  preserved  such  as  symmetry  and  positive-definiteness  [23].  From 
Equation  (67),  the  relationship  between  the  acceleration  of  the  active  joints  and  the 
passive  joints  is  represented  by  Equation  (68). 

+  ^pp^p  +  =  0 

or 

4p  =  -H^pHj^-H-;^b^ 


(68) 
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This  can  be  rewritten  as: 


(69) 


The  term  on  the  left  side  of  Equation  (69)  is  viewed  as  the  virtual  acceleration  of  the 
passive  joints.  Therefore,  analysis  of  how  active  joint  acceleration  effects 

passive  joint  acceleration  {q^)  involves  careful  study  of  the  Me  matrix.  The  following 
results  apply  to  the  Me  matrix  [23]; 

1 .  If  row  /■ ,  1  <  /■  <  p,  in  matrix  Me  contains  only  zeros,  the  zth  passive  joint  cannot  be 
controlled  via  dynamic  coupling  with  the  active  joints. 

P  y  then  r  passive  joints  can  be  controlled  at  every  instant,  while  p  —  r 
passive  joints  cannot.  The  p  -  r  passive  joints  will  depend  linearly  on  the 
acceleration  of  the  other  /"joints. 

3.  In  order  to  independently  control  all  p  passive  joints,  at  least  p  actuators  are 
necessary. 

This  analysis  tool  is  used  in  Section  6.5  to  help  determine  the  dynamic  coupling  and 
controllability  of  the  RUM  actuated  system. 


6.4  Reachability  Analysis  -  RUM  Actuated  System 

This  section  uses  the  controllability  condition  tool  to  make  comparisons 
between  the  three  models  representing  the  RUM  actuated  system.  Model  1  and  Model 
2  exhibit  the  two  extremes  of  the  controllability  condition.  Model  3  appears  to  be 
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somewhere  in  between  as  will  be  explained  below.  Approaching  the  controllability 
issue  in  this  way  sheds  considerable  light  into  a  very  complex  topic. 

The  RUM  actuated  system  consists  of  the  six  state  variables  previously  defined 
in  Chapter  5: 


(elev  postion) 

(elev  velocity) 

II 

(x-elev  position) 

II 

(x-elev  velocity) 

II 

(RUM  position) 

—  ^3 

(RUM  velocity) 

Putting  the  RUM  actuated  system  into  Equation  (65)  format  results  in  Equation  (70): 


^3x3 

^3*3 

X  + 

^3*3 

_®3x3 

-/f-’C 

H-\ 

where:  H  and  C  were  previously  defined  in  the  Chapter  4  calculations.  The  control 
input,  X,  is  the  single  torque  input  to  the  RUM  torque  motors.  This  causes  the  system 
to  be  under-actuated  as  discussed  previously.  To  accurately  describe  this  under¬ 
actuated  system  for  controllability  analysis,  g(x)  must  account  for  this  single  input. 


Therefore,  for  r  =  [o  0 


0. 


3x3 


g(x)is  the  last  column  of 


0. 

H 


3jc3 

-1 
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6.4.1  Model  1  Controllability  Condition 

For  Model  1,  the  controllability  condition  matrix  is  Equation  (71)  where  s(q3) 
and  c(q3)  stand  for  sin(q5)  and  cosCq^)  respectively. 

(71) 
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There  are  several  interesting  observations: 

1 .  The  matrix  (cc)  is  a  function  of  RUM  position  and  velocity  only  ( q^  and  qj ), 

2.  The  matrix  is  full  rank  no  matter  what  the  RUM  position  is  as  long  as  the  RUM  is 
rotating  (i.e.  velocity  ^  0). 

3.  Even  though  the  matrix  is  full  rank,  the  RUM  position  effects  sparseness  of  the 
matrix.  This  in  turn  implies  less  control  effectiveness  to  the  RUM  actuation.  A 
comparable  example  would  be  control  of  the  lateral  dynamics  of  an  airplane 
actuated  using  only  rudder  input  [24].  Even  though  the  controllability  matrix  has 
full  rank  and  the  system  is  controllable,  the  maneuverability  of  the  airplane  would 
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be  greatly  degraded  with  this  type  of  control.  “Controllability  does  not  guarantee  a 
high-quality  control,  it  just  guarantees  that  all  the  states  can  be  manipulated  to  zero 
in  some  fashion  in  some  finite  time.” 

4.  The  above  observation  indicates  the  periodic  nature  of  the  controllability  for  the 
system  as  discussed  in  Chapter  2.  Equations  (72)  and  (73)  show  how  the 
controllability  matrix  changes  as  the  RUM  position  goes  from  qs  =  0°  to  qs  =  90° 
respectively.  Note  ^3=71  rad/sec. 


(72) 


(73) 
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There  are  several  interesting  observations  made  from  this  analysis: 

1.  The  matrix  is  also  a  fiinction  of  RUM  position  and  velocity  only. 

2.  The  matrix  never  has  full  rank;  it  always  has  a  rank  of  2. 

3.  Since  the  matrix  is  less  than  full  rank,  Model  2  cannot  be  controlled  at  every 

instant  in  time.  Scanning  motion,  however,  is  controllable  for  Model  2. 
Conclusion:  the  system  dynamics  produce  the  necessary  motion  for  scanning  even 
though  they  are  not  always  controllable. 

4.  In  calculating  the  Lie  Brackets  for  columns  3,  4,  5,  and  6,  the 

Vg  •  /  and  ¥/■  •  g  terms  completely  negate  each  other,  resulting  in  the  zero  vectors. 

This  is  due  to  the  reaction  terms  in  Model  2.  Therefore,  the  reaction  terms  negate 
a  significant  part  of  the  controllability  of  the  system. 
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6.4.3  Model  3  Reachability  Condition 

For  Model  3,  the  Lie  Brackets  associated  with  Equation  (66)  quickly  become 
very  complicated  due  to  the  complexity  of  the  Model  3  representation.  Maple™  was 
used  to  facilitate  calculation  of  the  Lie  Brackets  for  Model  3.  Because  of  the 
complexity  and  recursive  nature  of  higher  order  Lie  Brackets,  Maple™  was  only  able 
to  calculate  the  first  three  Lie  Brackets.  The  calculations  for  the  first  three  Lie 
Brackets  show  linearly  independent  vectors  in  the  controllability  condition  matrix.  The 
following  conclusions  result  fi-om  the  controllability  analysis  of  Model  3: 

1 .  The  cc  matrix  is  a  function  of  all  states. 

2.  Since  the  complexity  of  the  Lie  Brackets  increases  with  each  recursion,  it  appears 
that  the  controllability  matrix  will  be  full  rank.  The  full  rank  matrix  seems  to  be 
due  primarily  to  the  cross-coupling  between  axes  which  does  not  appear  in  Models 
1  and  2.  Because  the  cc  matrix  is  a  function  of  all  states,  there  may  be  certain 
states  (i.e.  positions  and  velocities)  that  cause  the  cc  matrix  to  lose  rank  and  thus 
system  controllability.  This  is  unlikely  because  of  the  complexity  of  the  matrix. 
However,  a  decrease  in  control  effectiveness  and  system  maneuverability  may 
occur  at  certain  states. 

3.  Because  Model  3  encompasses  both  Models  1  and  2,  it  has  a  controllability 
condition  somewhere  between  Models  1  and  2.  Model  1  represents  a  system  that 
is  completely  controllable  and  Model  2  represents  a  system  that  is  not  controllable 
at  every  instant  in  time. 
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4.  The  analysis  done  here  and  in  Section  6.1  seems  to  indicate  that  Model  3 
represents  a  situation  where  the  system  is  controllable  but  the  ‘maneuverability’  is 
poor  and  it  must  rely  on  large  inputs  and  system  dynamics  to  accomplish  certain 
motions. 

Since  the  RUM  actuated  system  is  under-actuated,  the  control  input  is  based  on  the 
amount  of  coupling  between  the  actuator  and  the  telescope.  Therefore,  to  further 
understand  the  controllability  of  Model  3,  a  coupling  index  measuring  this  coupling  is 
necessary. 

6.5  Coupling  index  —  RUM  Actuated  System 

Unlike  Models  1  and  2,  Model  3  lends  significant  insight  into  the  amount  of 
coupling  available  for  control.  In  the  next  few  sections  the  coupling  index  is 
calculated  and  compared  for  each  model. 

6.5.1  Model  1  Coupling  index 

Putting  Model  1  into  Equation  (67)  form  results  in  Equation  (75). 

^RUM  ^  ®  ^3  ®  ^3 

0  0  ^1  +  2q^mrsm{q^)  =  0 

0  0  q^  -  2q^mr  cos(q^)  0 

Using  (75)  to  calculate  the  Me  matrix  results  in  Equation  (76). 
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The  following  observations  are  made  from  this  result: 

1.  Indicates  that  it  is  not  possible  to  control  the  elevation  joint  and  cross-elevation 
joint  at  every  instant  via  coupling  to  the  RUM  joint. 

2.  Appears  to  contradict  earlier  findings  on  controllability  condition  in  Section  6.4. 1 . 
This  index,  however,  measures  inertia  coupling  only  and  does  not  account  for 
Coriolis  or  centripetal  coupling  which  are  important  factors  in  RUM  control.  Me  = 
0  is  consistent  with  the  fact  that  Model  1  does  not  account  for  coupling  of  the 
elevation  and  cross-elevation  axes  to  the  RUM  via  inertia  terms.  This  analysis 
shows  that  the  inertia  terms  cannot  be  ignored  in  modeling  the  RUM  actuated 
system. 

3.  The  pointing  motion  observed  in  Model  1  tests  are  generated  strictly  from 
centripetal  terms  as  previously  observed. 

6.5.2  Model  2  Coupling  index 

Putting  Model  2  into  Equation  (67)  form  results  in  Equation  (77). 


110 


^RUM 

0 

0" 

% 

0 

-2mrdcos(q^) 

4 

0 

% 

-h 

2q^1nr&m(^q^) 

= 

0 

-2mrdiv[\{q^) 

0 

4. 

-2q^mrcos{q^) 

0 

(77) 


Using  Equation  (77)  to  calculate  the  matrix  results  in  Equation  (78). 
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The  following  observations  are  made  from  this  result: 

1 .  Indicates  that  the  passive  joints  are  both  controlled  via  dynamic  coupling  with  the 
active  joints. 

2.  The  terms  in  this  coupling  matrix  were  previously  identified  as  the  reaction  terms 
in  Chapter  2  analysis.  These  terms  keep  the  telescope  from  pointing  when  a 
variable  RUM  velocity  control  is  used.  In  essence,  they  “control”  the  telescope  so 
that  variable  speed  cannot  affect  pointing  motion. 

3.  Since  the  number  of  active  joints  (r  =  1)  is  less  than  the  number  of  passive  {p  =  2), 
one  of  the  passive  joints  cannot  be  independently  controllable  at  every  instant.  In 
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fact,  it  appears  there  is  a  trade  off  between  control  of  each  axis  as  qs  rotates  from  0 
to  2%  again  showing  the  periodic  controllability  of  the  system. 

6.5.3  Model  3  Coupling  index 

Putting  Model  3  into  Equation  (67)  form  results  in  Equation  (79). 
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Where:  Hij  is  as  previously  defined  in  Chapter  4  and  Appendix  C  and  C(q,q)^  are  the 
Coriolis  and  centripetal  terms. 

Using  Equation  (79)  to  calculate  the  Me  matrix  results  in: 
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Where  detailed  values  for  Me  are  shown  in  Appendix  D.  The  following  observations 
are  made  from  this  result: 

1.  The  Me  matrix  is  a  function  of  the  RUM  position  angle  and  the  cross-elevation 
position  angle  only.  There  is  no  elevation  position  term  in  the  matrix.  This 
indicates  that  the  coupling  of  the  RUM  actuator  to  the  elevation  joint  is  through 
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the  cross-elevation  joint.  This  makes  sense  physically  since  the  elevation  joint  is 
in  the  base  frame. 

2.  The  reaction  terms  are  in  the  Me  matrix  similar  to  Model  2  but  there  are  other 
inertia  terms  that  might  be  used  for  control. 

3.  Since  the  number  of  active  joints  (r  =  1)  is  less  than  the  number  of  passive  (p  =  2), 
one  of  the  passive  joints  cannot  be  independently  controllable  at  every  instant  of 
time. 

6.5.4  Summary 

The  coupling  index  is  an  important  tool  used  in  controllability  and  reachability 
analysis.  In  the  RUM  actuated  case,  however,  it  only  shows  part  of  the  picture 
involved  in  control.  It  verifies  the  observations  made  in  the  variable  RUM  rate 
analysis  and  explains  how  the  inertias  couple  to  prevent  pointing  motion.  It  does  not 
show  the  influence  of  coriolis  and  centripetal  terms  which  are  major  factors  generating 
scanning  motion. 

6.6  Modifications  to  Control  Input 

The  controllability  condition  analysis  of  Model  3  indicates  that  the  RUM 
actuated  system  is  controllable.  The  control  index  analysis  indicates  that  the  system  is 
not  controllable  at  every  instant  of  time.  It  also  indicates  that  the  coupling,  although 
present,  may  not  be  enough  to  affect  an  efficient  pointing  control  scheme.  This 
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section  discusses  possible  control  scheme  changes  that  may  achieve  the  desired 
pointing  control. 

Using  Polites’  original  control  scheme  shown  in  Equation  (62),  one  possible 
change  in  the  control  input  would  be  to  vary  the  RUM  speed  above  the  nominal  speed 
instead  of  varying  it  above  and  below  the  nominal  speed  as  suggested  by  Polites. 
Figure  36  shows  a  comparison  between  the  two  speed  profiles. 


Reference  Velocity  Comparisons 


0  5  10  15 


Figure  36  Speed  Profile  Comparison 


This  control  is  accomplished  by  using  RUM  velocity  and  position  feedback  and 
simply  adding  an  off-set  to  the  reference  RUM  speed  as  shown  in  Equation  (81). 
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4(r./)  =  (nominal  speed  +  ■^) + -^008(^3  + 


Where  A  is  the  change  in  maximum  to  minimum  RUM  speed  and  (|)  is  a  phase  shift 
term  used  to  adjust  the  location  of  RUM  acceleration  and  deceleration  in  each 
revolution.  By  varying  the  RUM  speed  above  the  nominal  speed,  an  average  speed 
change  occurs.  Note  that  this  is  different  than  just  changing  the  RUM  velocity  to  a 
higher  constant  value.  Changing  to  a  higher  constant  RUM  velocity  results  in  a  faster 
scan  only,  Avithout  pointing  motion.  Varying  the  RUM  speed  as  shown  in  Figure  36 
results  in  initiating  multiple  transient  responses  as  the  RUM  speed  goes  from  nominal 
speed  to  maximum  speed.  It  is  analogous  to  turning  the  system  on  and  off  and  using 
the  small  transient  behavior  to  affect  pointing.  Note  that  varying  the  RUM  speed 
above  the  nominal  also  allows  for  a  larger  change  in  velocity  (A)  during  each 
revolution  of  the  RUM  without  worrying  about  the  velocity  going  negative  which  is  a 
problem  with  the  original  control  input.  Having  a  nominal  speed  above  zero  ensures  a 
non-zero  RUM  velocity,  essential  for  control.  Theoretically  there  would  be  an 
infinitely  large  control  input  available  for  pointing  actuation  which  may  solve  some  of 
the  control  issues  addressed  earlier.  Practically,  however,  power  is  limited  and  at  a 
premium.  Therefore  it  must  be  conserved  and  used  efficiently.  Figure  37  shows  the 
results  of  the  change  in  control  input  for  cross-elevation  axis  motion  using  A  =  4. 
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Figure  37  Cross-Elevation  Axis  Motion  with  New  Control  (30  sec  simulation) 

For  elevation  axis  motion,  a  much  larger  A  is  required  in  the  reference  speed  to  induce 
a  similar  amount  of  motion.  Figure  38  shows  the  results  of  elevation  axis  motion  for 
A  ten  times  that  used  for  the  cross-elevation  motion. 
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Elevation  position  vs  X-Elevation  position 
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Figure  38  Elevation  Axis  Motion  with  New  Control  (A  times  10) 


The  following  significant  observations  result  from  the  new  control  input: 

1.  Hardware  limitations  and  large  input  requirements  will  restrict  the  maximum 
RUM  speed  thus  reducing  the  effectiveness  of  this  control  scheme.  Another 
pointing  strategy  may  be  more  appropriate.  Note  that  this  control  scheme  has  not 
been  tested  on  the  actual  system. 

2.  It  would  appear  that  the  motion  in  cross-elevation  axis  and  elevation  axis  should 
be  symmetric.  Linearized  models  of  the  system  will  be  symmetric  but  non-linear 
models  of  the  system  may  not  be.  Another  example  of  the  asymmetry  in  the 
system  is  the  existence  of  a  singularity  in  one  axis  but  not  in  the  other.  Since  the 
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elevation  axis  motion  is  defined  in  the  base  frame,  the  use  of  a  universal  (U)  joint 
configuration  at  the  gimbal  mount  in  the  RUM  system  introduces  a  singularity 
when  the  RUM  rotation  is  in  the  same  plane  as  the  elevation  axis  motion.  The 
singularity  occurs  because  the  RUM  axis  motion  cannot  be  distinguished  fi’om 
elevation  axis  motion.  This  type  of  configuration  contributes  to  the  asymmetry  in 
the  motion  of  the  elevation  and  cross-elevation  axes.  Even  with  this  asymmetry, 
some  pointing  motion  is  possible  with  the  new  control  input.  Note  that  if  the  base 
frame  motion  is  changed  fi’om  elevation  axis  motion  to  cross-elevation  axis 
motion,  the  singularity  is  switched  as  well. 

3.  The  difference  in  cross-elevation  axis  and  elevation  axis  motion  and  control 
requirements  is  also  partly  explained  by  the  coupling  index  from  Section  6.5.3. 
The  absence  of  the  elevation  axis  variable  in  the  Me  matrix  and  the  fact  that  there 
are  more  passive  joints  than  active  joints  indicates  that  one  passive  joint  cannot  be 
controlled  at  every  instant. 

4.  There  is  a  significant  amount  of  coupling  between  axes  that  in  essence  prevents 
large  pointing  motions  in  the  elevation  axis.  This  could  account  for  the  success  of 
the  disturbance  test  conducted  in  Chapter  2.  A  small  disturbance  in  the  elevation 
axis  did  not  have  much  impact  on  the  motion  of  the  telescope  when  Polites’ 
control  scheme  is  implemented.  Again,  the  coupling  index  from  Section  6.5.3 
helps  explain  this  phenomenon. 
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6.7  System  Configuration  Changes 

Using  the  single  RUM  control  strategy  only  may  not  be  the  most  efficient  or 
practical  means  of  controlling  pointing.  A  possible  solution  to  the  under-actuated 
control  issues  raised  previously  is  to  add  another  actuator.  One  obvious  solution  is  to 
allow  the  RUM  arms  to  rotate  -without  the  180°  spatial  displacement  requirement. 
This  would  in  essence  add  an  additional  actuator  to  the  system  by  using  the  hardware 
already  present.  There  would  be  four  joints  with  4  degrees  of  freedom  and  two 
actuators  available  to  control  them.  This,  however,  would  cause  lateral  motion  about 
the  center  of  mass  of  the  telescope  causing  pendulum  like  oscillations  in  the  balloon 
borne  system.  Polites  originally  designed  the  RUM  actuated  system  with  the  180° 
spatial  displacement  to  prevent  this  lateral  motion  because  it  destabilizes  the  gondola 
platform  and  makes  the  balloon  borne  telescope  unusable.  This  configuration, 
however,  could  be  used  for  a  space  borne  system  since  the  lateral  motion  could  be 
used  for  pointing.  The  space  borne  system  will  require  extensive  model  changes  due 
to  the  increased  degrees  of  freedom  compared  to  the  current  gimbal  mounted  model. 
This  configuration  will  be  addressed  in  the  future  work  section  of  Chapter  7.  Two 
other  possible  actuator  additions  are  promising.  They  are  a  variable  gimbal  braking 
actuator  and  a  variable  RUM  arm  length  actuator.  These  configurations  are 
investigated  in  the  next  two  sections. 
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6.7.1  Variable  Gimbal  Braking 

One  possible  solution  to  reducing  the  auxiliary  control  system  hardware  may 
be  to  reduce  the  complexity  of  the  system  by  using  simple  brakes  at  the  gimbal  mount 
instead  of  torque  motors,  reaction  wheels  or  CMGs.  Obviously  this  configuration 
would  only  be  suitable  for  balloon  borne  systems  because  the  braking  system  requires 
a  platform  to  brake  against.  Simple  brakes  have  been  used  on  numerous  occasions  as 
a  simple  way  to  increase  actuation  for  under-actuated  systems  [23,25],  A  variable 
braking  system  would  apply  a  fi'iction  force  at  the  gimbal  mount  in  the  elevation  and 
cross  elevation  axis.  The  RUM  would  rotate  at  a  constant  speed  and  the  braking 
would  be  synchronized  with  the  RUM  position  to  affect  pointing  in  different 
directions.  Equation  (82)  shows  an  example  of  the  friction  force  generated  by  the 
braking  system  necessary  for  pointing  control. 

r,  =  -(0. 5  +  0.5  cos(^3  +  ^))^, 

72  =  -(0.5  +  0.5  cos(^3  +  (I>))q2 

This  configuration  would  take  advantage  of  the  RUM  motion  and  allow  the  telescope 
to  continue  scanning  at  the  same  time  it  was  being  pointed.  <|>  is  used  to  change  the 
direction  of  the  pointing  command.  Figure  shows  the  open  loop  response  to  such  a 
command  for  (j)  =  45°. 
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Elevation  position  vs  X-Elevation  position 


Figure  39  Variable  Gimbal  Braking  Pointing  Actuation 

6.7.2  Pointing  Control  using  Variable  RUM  Arm  Length 

Adding  an  actuator  to  vary  the  RUM  arm  length  is  another  possible  solution  to 
the  under-actuated  control  issues  raised  previously.  In  this  configuration,  the  RUMs 
will  continue  to  rotate  as  before  (i.e.  180°  spatial  displacement)  at  a  constant  velocity 
but  the  RUM  arm  length  would  vary  during  each  revolution.  Since  the  variable  arm 
length  adds  new  dynamics  to  the  system,  a  new  model  is  required.  Applying  the 
Lagrange  Formulation  to  this  new  configuration  results  in  equations  of  motion  given 
by  Equation  (83). 
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where:  and  %  are  the  RUM  angular  velocity  and  acceleration,  respectively  and 


and  q^  are  the  RUM  arm  velocity  and  acceleration,  respectively.  Varying  the  RUM 

arm  length  by  as  little  as  1.2  inches  (from  6  inches  to  7.2  inches)  generates 
considerable  pointing  motion  as  shown  in  Figure  40. 


Elevation  position  vs  X-Elevation  position 


Figure  40  Variable  RUM  Arm  Length  Pointing  Actuation 
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Therefore,  variable  RUM  arm  length  appears  to  be  an  effective  method  for 
accomplishing  scanning  and  pointing.  Since  the  180®  spatial  displacement  in  RUM 
positions  is  maintained,  lateral  motion  should  be  eliminated  making  this  configuration 
suitable  for  both  balloon  and  space  borne  systems.  Varying  the  RUM  arm  length, 
however,  will  require  another  actuator,  meaning  major  hardware  changes  to  the 
physical  system.  This  will  require  an  investigation  into  the  mechanical 

implementation  of  another  actuator.  Some  suggested  ideas  are  a  geared  camshaft  that 
can  provide  a  variable  arm  length  at  different  locations  in  the  RUM’s  rotation  or  a 
spring  loaded  telescoping  arm.  This  configuration  does  eliminate  the  requirement  for 
an  auxiliary  control  system  but  it  may  be  difficult  and  complicated  to  implement 
physically. 

6.8  Conclusions 

This  chapter  investigates  the  feasibility  of  pointing  control  using  RUM 
actuators.  System  controllability  condition  and  coupling  index  are  two  valuable  tools 
used  in  reachability  analysis.  Each  has  its  limitations  and  must  be  used  carefiilly.  The 
controllability  matrix  can  be  quite  complex  and  the  coupling  index  shows  only  the 
inertia  coupling.  This  chapter  also  provides  a  sampling  of  different  pointing  control 
strategies  and  configurations.  Model  3  provides  a  detailed  representation  available  for 
control,  but  discovering  that  control  scheme  will  require  considerable  research.  Simple 
control  schemes,  such  as  a  variable  RUM  rate  control  do  not  appear  to  be  highly 
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effective  for  pointing  control  at  this  point  in  the  research.  Two  simpler  solutions  are 
variable  gimble  braking  or  variable  RUM  arm  length  configurations  and  control 
schemes.  Implementation  of  these  will  require  substantial  hardware  changes  but  will 
reduce  or  eliminate  the  auxiliary  control  system  requirements.  Much  more  research  is 
required  to  determine  a  control  strategy  and  configuration  that  will  be  effective  and 
efficient  for  pointing  actuation. 

The  RUM  actuated  system  contains  very  complex  dynamics.  Under-actuated 
system  analysis  has  shown  that  a  3  degree  of  freedom  system  cannot  be  controlled  at 
every  instant  of  time  by  a  single  actuator.  That  does  not  mean,  however,  that  the 
RUM  actuated  system  is  not  usable.  For  example,  a  single  RUM  actuator  successfully 
produces  accurate  scanning  motion.  This  begs  the  question,  “Is  the  motion  generated 
by  the  actuator  a  motion  we  can  use  (but  may  not  be  able  to  control  at  every  time 
instant  but  possibly  on  average)?”  In  other  words,  if  the  RUM  device  actuates  motion 
that  can  be  used  for  scanning,  perhaps  other  physical  properties  of  the  RUM  device 
can  be  controlled  to  give  the  pointing  motion  desired.  Further  research  is  required  in 
this  area. 


CHAPTER  7 


FUTURE  WORK  AND  CONCLUSIONS 

The  RUM  device  was  developed  at  NASA  to  partially  meet  the  unique  control 
challenges  of  space  and  balloon-borne  gamma  ray  and  x-ray  imagining  telescopes. 
This  dissertation  takes  the  analysis  of  this  unique  actuator  to  a  new  level.  It  provides  a 
systematic  method  of  modeling  the  RUM  actuated  system.  The  modeling  approach 
draws  from  robotics  but  extends  the  application  of  the  Denavit-Hartenberg  (DH) 
coordinate  convention  and  the  Lagrange  Formulation  to  this  unusual  “robot” 
configuration.  The  RUM  actuated  system  is  unique  in  a  robotic  sense  since  it  is  not  an 
efficient  use  of  joints  or  links  and  is  under-actuated,  having  only  the  RUM  torque 
motors  for  actuation.  Through  the  application  of  this  modified  modeling  approach, 
this  dissertation  provides  the  first  known  complete  model  of  the  RUM  actuated 
system.  Prior  models  do  not  accurately  account  for  coupling  between  the  telescope 
axes  and  the  RUM  device  or  provide  an  accurate  prediction  of  telescope  motion  under 
all  operating  conditions. 

Obtaining  this  complete  model  facilitates  detailed  control  analysis,  which  helps 
determine  the  feasibility  of  pointing  actuation  using  the  RUM  device.  This  analysis 
draws  from  non-linear  reachability  conditions  and  the  dynamic  coupling  index.  The 
results  of  the  feasibility  study  indicate  that  simple  variable  RUM  rate  control  schemes 
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do  not  appear  to  be  highly  effective  for  pointing  control.  Experimental  simulations 
give  insight  into  the  physical  behavior  of  the  system.  The  results  show  that  pointing 
motion  generated  by  RUM  rotation  is  due  primarily  to  start-up  transient  behavior. 
System  configuration  changes,  such  as  variable  gimbal  braking  or  variable  RUM  arm 
length,  appear  to  be  effective  means  of  obtaining  pointing  but  substantial  hardware 
changes  are  necessary.  These  approaches,  however,  will  help  simplify  or  eliminate  the 
auxiliary  control  system.  The  feasibility  study  also  points  out  the  limitations  of 
existing  analysis  tools.  For  complex  systems,  the  Lie  Bracket  calculations  quickly 
become  unmanageable  and  the  coupling  index  provides  valuable  information  about  the 
inertia  coupling  but  does  not  account  for  coriolis  or  centripetal  coupling,  a  major 
factor  in  RUM  actuated  motion.  Analysis  of  the  RUM  actuated  system  is  a  rich  and  in- 
depth  area  of  research.  It  yields  numerous  other  areas  of  study  that  will  lead  to  years 
of  future  research  topics  as  discussed  in  the  next  section. 

7.1  Future  Research 
1 .  RUM  Phasing 

Allowing  the  RUM  arms  to  rotate  independently  from  each  other  seems  to  be 
the  next  logical  approach  for  increasing  the  number  of  actuators  since  the  hardware  is 
already  in  place,  i.e.  the  two  RUM  actuators  can  be  phased  different  by  control  alone. 
Increased  computing  power  will  be  required  and  there  are  certain  drawbacks  to  using 
the  RUMs  in  this  manner  as  discussed  in  Chapter  6.  Also,  since  lateral  motion  may  be 
a  by-product  of  the  RUM  phase  approach,  some  experiment  modification  will  be 
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necessary.  The  telescope  (T’  beam)  must  be  suspended  to  simulate  a  gondola 
configuration.  Suspending  the  telescope  will  allow  lateral  motion  and  a  more  accurate 
experimental  setup.  Model  3  must  be  modified  to  allow  for  lateral  motion  in  the 
cross-elevation  and  elevation  axis  plus  rotational  motion  in  the  line  of  sight  axis. 

2.  Variable  RUM  Arm  Length 

Simulations  involving  variable  RUM  arm  length  appear  to  show  a  promising 
method  for  accomplishing  scanning  and  pointing.  Varying  the  RUM  arm  length, 
however,  requires  another  actuator  which  means  major  hardware  changes. 
Investigation  into  the  mechanical  implementation  of  another  actuator  is  necessary. 
Some  suggested  ideas  are  a  geared  camshaft  that  can  provide  a  variable  arm  length  at 
different  locations  in  the  RUM’s  rotation.  The  development  of  a  closed  loop  control 
scheme  incorporating  elevation  and  cross-elevation  motion  is  necessary  as  well. 

3 .  Variable  Gimbal  Braking 

Variable  gimbal  braking  appears  to  be  the  most  effective  and  accurate  pointing 
control  scheme  studied  in  this  dissertation.  It  takes  advantage  of  the  RUM  motion  and 
is  considerably  less  complex  than  other  Auxiliary  Control  System  (ACS)  hardware. 
Again,  hardware  changes  are  necessary  along  with  the  development  of  a  closed  loop 
control  scheme 

4.  Linear  Scan  Configuration 

The  circular  scan  was  originally  studied  because  two  axis  pointing  is  necessary 
for  telescope  applications  and  both  elevation  axis  and  cross-elevation  axis  motion  are 
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affected  with  the  circular  scan  configuration.  Since  it  was  shown  (in  Chapter  6)  that 
3-degrees  of  freedom  cannot  be  controlled  at  every  instant  by  a  single  RUM  actuator, 
perhaps  a  step  back  is  necessary.  The  linear  scan  configuration  meets  the  minimum 
coupling  index  criteria  (i.e.  there  must  be  at  least  as  many  active  joints  as  passive 
joints).  Studying  the  linear  scan  motion  may  provide  some  clues  and  possible 
solutions  to  using  a  single  actuator  to  accomplish  pointing  along  a  single  axis  (i.e.  one 
axis  pointing  may  be  possible  with  a  single  actuator).  This  is  an  easier  problem  that 

may  shed  light  on  single  actuator  control  but  it  may  not  directly  apply  to  the  circular 
scan  configuration. 

5.  Unique  Actuators 

Unique  types  of  actuators,  such  as  the  RUM  device,  provide  a  wealth  of 
potential  research  topics  in  the  area  of  controlling  mechanical  systems.  The  RUM 
device  is  a  unique  actuator  because  it  uses  centripetal  force  to  affect  motion.  Further 
investigation  is  warranted  to  determine  what  other  types  of  actuators  are  available  and 
whether  they  have  similar  modeling  and  analysis  issues  as  those  encountered  with  the 
RUM  actuated  system.  The  question  to  ask  when  looking  at  these  types  of  actuators  is 
not  whether  they  are  completely  controllable  but  whether  the  motion  generated  by  the 
actuators  can  be  used  in  some  form  to  control  mechanical  system  behavior?  Perhaps 
another  actuator  can  provide  the  pointing  motion  as  part  of  its  physical  properties. 
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6.  Under-actuated  Systems 

Under-actuated  system  analysis  has  shown  that  a  3-degree  of  freedom  system 
cannot  be  controlled  at  every  instant  by  a  single  actuator.  But,  the  RUM  system  is 
controlled  in  the  scanning  mode  with  a  single  actuator.  This  is  because  the  motion  of 
one  axis  depends  on  the  motion  of  the  other  axis.  This  dependence  is  very  predictable 
and  can  be  controlled  by  changing  system  parameters  such  as  RUM  arm  length  and 
RUM  mass.  The  RUM  actuated  system  appears  to  fit  into  the  category  of 
‘nonholonomic’  systems.  Nonholonomic  systems  are  best  described  by  comparing 
them  to  ‘holonomic’  systems.  Given  two  points  in  space,  A  and  B,  a  holonomic 
systems  can  take  arbitrary  paths  to  get  from  one  point  to  the  other.  For  nonholonomic 
systems,  motion  between  points  A  and  B  are  constrained  to  specific  paths  [26]. 
Examples  of  nonholonomic  systems  are  automobiles,  space-based  robot  manipulators, 
and  orbiting  satellites.  A  classic  example  of  controlling  a  nonholonomic  system  is 
parallel  parking  a  car.  The  car  must  be  moved  along  a  certain  path  to  move  the  car 
into  the  parking  space.  Backing  the  car  into  the  space  is  the  optimum  solution.  The 
RUM  system  may  be  a  similar  situation.  The  RUM  must  rotate  in  order  to  affect 
elevation  and  cross-elevation  axes  motion.  This  motion  constrains  the  path  that  the 
elevation  and  cross-elevation  axes  can  take.  If  unlimited  power  is  available,  RUM  rate 
variations  will  generate  pointing  along  this  constrained  path.  If  not,  another  approach 
is  necessary  similar  to  backing  the  car  into  the  parking  space.  The  discovery  of  these 
types  of  control  are  usually  ad  hoc  in  nature  and  will  require  considerable  research. 
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7.  Additional  Non-linear  Analysis  Tools 

Limitations  in  the  reachability  analysis  tools  appear  to  indicate  a  need  for 
additional  non-linear  analysis  tools.  A  tool  that  is  not  unduly  complicated  is  needed  to 
analyze  the  coupling  of  centripetal,  coriolis,  and  gravitational  terms.  These  three 
terms  may  be  significant  factors  in  the  control  actuation  of  certain  systems  (e.g. 
gravity  gradient  control  of  space  satellites).  Having  an  analysis  tool  that  can  describe 
their  coupling  with  other  system  dynamics  would  greatly  facilitate  reachability 
analysis. 

7.2  Summary  of  Contributions 

The  research  presented  in  this  dissertation  provides  a  number  of  contributions 
in  the  area  of  RUM  actuated  system  modeling,  analysis,  and  control  as  follows: 

•  Developed  the  first  model  that  accounts  for  nonlinear  coupling  between  payload 
axes  and  the  RUM  devices  (Chapter  4). 

•  Showed  that  the  model  agrees  with  pointing  control  experimental  results  (Chapter 
5).  In  contrast,  earlier  models  give  incorrect  predictions. 

•  Identified  dynamic  effects  (terms  in  the  model)  that  prevent  pointing  (Chapter  6). 

•  Placed  the  pointing  problem  in  the  framework  of  under-actuated  robotic  systems 
(Chapter  6).  Showed  that  necessary  conditions  for  pointing  control  are  not 
satisfied  by  present  system. 

•  Identified  several  potential  solutions  to  the  pointing  problem  (Chapter  6). 

•  Identified  numerous  other  areas  of  study  that  will  provide  years  of  future  research. 
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7.3  Closing  Thoughts 

This  dissertation  has  taken  a  significant  step  toward  the  development  of  a 
comprehensive  attitude  control  strategy  for  RUM  actuated  systems  by  providing  the 
first  complete  system  model  and  initial  control  analysis.  The  detailed  model  developed 
in  this  dissertation  provides  a  valuable  tool  for  continued  research  in  the  area  of 
pointing  control.  Even  though  the  system  does  not  appear  to  be  completely 
controllable,  that  doesn’t  mean  it  is  not  useable.  Perhaps  it  is  a  matter  of  determining 
a  better  control  approach  that  accounts  for  these  system  limitations. 
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APPENDIX  A 


KINEMATIC  MODELING  DETAILS 


1.  Homogeneous  Transformations: 
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2.  Kinematic  Equations: 
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VELOCITY  JACOBIANS 


1 .  Linear  Velocity  Jacobians: 
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-sm.^thetal')  cos{theta2')  r  zos(^theta4)  —  s\D.{thetal)  %m.{tketa2)  d , 
-zosi^thstal)  r  cos{theta4)  +  sm.{theta2)  skii^thetal)  r  s,\ii{theta4)  ,  0] 

[ 0  ,  -^{theta2')  r  zos{theta4)  +  zos{theta2')  d ,  -zos{theta2)  r  smi^tketa4')  ,  0 ] 


JL5  = 


0 

0 

0 


0  0  0' 
0  0  0 
0  0  0 
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JL6-^ 

[ -iv^ihetal )  ^{O^ial')  r  coziiheta6')  -  zii%{thelal )  r  sm(theia6) 

+  sm(£/jetal)  cos(theta2)  d , 

cos(£ketal)  cos(theta2)  r  cos(th0ta6)  +  cos{thetaI)  ^{tketa2)  d  ,0  , 
-sm(tkeial)  r  cos(tketa6)  -  sm(the£a2)  cos(£hetaI)  r  sm(iAefatf)] 

[  cos{tketal )  sm(tketa2)  r  oos{theta6)  -  sh.{tketal )  r  ^{theta6) 

-  cosi^tketal)  zos{tketa2')  d , 

imfjthetal)  zos{theta2)r  cos{tketa6)  +  %h.{tketal')  sm{tketa2')  d ,  0  , 
tos{thetal)r  zos{tketa6)  -  STXi{theta2)  s,ki{thetal)  r  sva^thetaC)] 

[  0  ,  ^{tkeia2)  r  cos(iheia6)  -  cos(theta2)  d  ,0  ,  cos(tke£a2)  r  zm{iheta6)  ] 


2.  Angular  Velocity  Jacobian: 

'0  0  0  O' 

JAl-  ^  0  0  0 
.1  0  0  0. 

0  zh.{thetal )  0  0 

JA2  :=  0  -co%{tketal )  0  0 

.1  0  0  0_ 

0  ski(,thetal )  0  0 

JA3  .=  0  -cos(£k0tal)  0  0 

.1  0  0  0. 

0  ^(£k0tal)  cos^tkeial)  cos(tk0ta2)  O' 

JA4  :=  0  -cos(tk0tal)  sm(tk0tal)  cos{tk0ta2)  0 
.1  0  sm(tk0ta2)  0. 

0  ski(ike£al)  0  0 

JA5  —  0  -cos(tk0tal )  0  0 

.1  0  0  0. 


APPENDIX  C 


H  AND  C  MATRIX  VALUES 


Notational  note  for  H(^)  and  C(q,q)  calculations: 

thetal  =  q^  thetaldot  = 

theta2  =  q^  theta2dot  =  q^ 

theta4  =  theta6  =  q^  theta4dot  =  theta6dot  =  q^ 

1 .  H(^)  Matrix: 

"^[1  1  ]  mRUMr^  cos{theta4)^  +  2  mRUM tP"  +  IteU^  zo${tketa2p 
-  A  mRUM sm.(tkeia2)  r  cos(theta4)  oos{thsta2)  d  +  2  mRJJMp 

1  2  ]  ~  ^  ynRXJMp  c.o%[tketa2')  t,o%{j}ieta4')  -  2  mRJJMr  %v!^{theta2')  d)  si!n{theta4') 
I  3  j f"  cos(^tketa2 )  d  cos(^tketa4 )  +  mRUM P  sin(theta2 ) 
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^  — fnRUMr  cos{£keta2)  d  cos{tketa4^  +  mRUMr^  S}ii{tketa2) 


^^2  1  ]  fnRUMr^  cos(tfieia2)  cos(iAeia4)  -  2  mRUM r  sm.(theta2)  d')  ski(tketa4) 


o  1  —  +  2  mRJJM <P‘  -V  2  mRJJM zo%{JLkela4^ 


H  o ,  -mRJJM r  sm{tketa4 )  d 
L  J 


^[2  4  ]  ~  ^  ski{tketa4')  d 


■^|.  ^  ^  j : — mRJJM r  cos(^tketa2 )  d  cos(theta4)  +  mRJJM %‘ajthela2 ) 


«  o  1  •”  >"  ski(tke£a4)  d 


^^-mRUMr 


2 
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^[A  1  ]  ■”  ^  cos(theta2)  d  cos{theta4)  +  mRUMr^  sm(theta2) 


2 ]  ■”  f"  ski{tketa4)  d 


[4,4] 


2.  C(q,q)  Matrix  Values 


1  1  ]  ~  ^  fnRUM tos{tketa2 ) ^  r  cos{theta4 )  d 

+  {_-ltelX-  2  mRUMd^  +  2  mRTJMr^  ^o^{theta4'^ sm(theta2)  cos{tketa2) 
+  2  mRUM r  cos(tketa4)  d')  tketa2dot  +  ( 

2  mRUM cos(i/ieta2 cos(^theta4)  &ii{iheta4) 

+  2  mRUM s\a.{iketa2)  r  $h{theta4)  cos{theta2)  laf)  thsiaAdoi 
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C[  j  2]  ^  (-4  cos{tketa2)^  r  cos{theta4)  d 

2 mRUMd^  +  2 mRUMr^  tos{iheta4'^)  iya.{theta2)  C0z(theta2) 
+  2  mRUM r  co%{theta4)  d)  tketaldot  +  ( 

2  mRUMr^  sm{theta4')  sin(iAeia2)  zos{thsta4) 

-  2  mRUM r  ^itheta4)  toi{theta2)  d)tketa2dot 
+  (  2  mRUMr^  —  2  mRUMr^  cos{tketa4')^  cos{theta2')  iheta4dot 


c  =  (^mRUM s‘SD.{theta2)  r  sm{tketa4)  cos(theta2)  d 
L  ^ J 


+  mRUM cosi_theta2)^  cos{tketa4)  sm(theta4))  theta  1  dot 

+  ( -mRUM cos{theta4)^  +  mRUMr^')  cos(iAeia2)  theta2dot 
mRUM r  zm{theta4)  cos{tketa2)  d  theta4dot 


'[1.4] 


■  (^mRUM sai{theta2)  r  iva.{tketa4')  coi{theta2)  d 


■\r  mRUM cos{tketa2^  cos(^tketa4)  ^{tketa4^  thetaldot 

+  ( -mRUM cos{theta4)^  -V  mRUMr^')  cos(^theta2)  theta2dot 
•\-mRUMr  ^ki(^theta4')  cos{Lheta2')  d  theta4dot 


c  1 1  ^  mRUM co%{iheta2'^  r  coz{t}^ta4')  d 

[  1  J 

+  ( -2  mRUMr^  co^(tketa4'^  +  2  mRUMd^  Itel)^  ^(^theta2)  zoz(^tketa2) 

-  2  mRUMr  cos{_tketa4^  d)  tketaldot  + 

(-2  mRUMr^  cos(^theta4')'^  cos(_theta2')  —  2  mRUM r  cos{tketa4)  sin(^tketa2')  d^ 
theta4dot 
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oo^{theta4)  ^{theta4)  theta4dot 


^[2  3]  ^  cos{the£a4)^  cos(tketa2)  -  mRUMr  cos(£he£a4)  sm(iketa2')  d) 

thetaldot  -  mRTJMr  c<>%{theta4')  si3a.(theta4)  theta2dot 
-  mRUM r  cos{theta4')  d  tketa4dot 


*^[2  4]  ~  co%{theta4)^  cot{theta2)-  mRUM r  cos{theta4)  ^{theta2^  cjf) 

thetaldot  -  mRUMr^  c<>z(^theta4)  s\n{tketa4')  theta2dot 
-  mRUM r  zos{tketa4)  d  theta4dot 


^[3  1  ]  ^ cos(theta2)^  CQs{tketa4)  sm.{theta4) 


-  mRUM z\a.{theta2)  r  sm(theta4)  cos(theta2)  d')  thetaldot  + 

{^mRUMr  cos{theta4)  s\D.{theta2)  d  +  mRUM cos{tketa4)^  co%{_theta2'^ 
theta2dot 


'[3,2] 


?=  {,mRUMrzo%{iheta4)  sM^theta2)  d  ■¥ mRUM cos(theta4)^  cos(theta2)) 


thetaldot  +  mRUM cos(theta4)  sm(theta4)  tketa2dot 


c 


[3.3]' 
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"[3.4] 


:=0 


j i^-fftRUM co^{iheta2')^  cos^tketaA)  ^{thetaA') 

-  mRUM svD.{theta2 )  r  ^{theta4')  cos{theta2)  d)  theta! dot  + 

(.rnRUMr  cos(tketa4)  siD.(theta2)  d  +  mRUMt^  cos(tketa4)^  cc>s{theta2)) 
theta2dot 


*^[4  2]  ■”  cos{,tketa4)  $ki{theta2)  d  +  mRUMr^  cositheta4)^  cos(theta2)) 

tketaldot  +  mRUM co^{theta4)  %ki{tketa4)  theta2dot 


c  :=  0 
[4.3] 


c  :=  0 
[4.4] 


APPENDIX  D 


COUPLING  INDEX  -  MODEL  3 

Notational  note  for  coupling  index  calculations: 
thetal  = 
theta2  = 

theta4  =  theta6  = 


Me  11  ;=  2  r  mBJJM^ltelY cos{theta2')  d  tos(theta4')  —  ItelY r  siD(^theta2) 

+  2  mRUMd^  cos(theta2)  cos(theta4)  -  2  mRUMr^  cos(iheta4)^  $\n{theta2) 

+  2  mRUMr^  cos(theia2)  cos{theta4)  d  —  2  rmRUMd^  sm{theta2)  cos(theta4)^') 
j{-cositheta2)^  ItelXItelY-  2  cot{iheta2'^  ItelXmRUMd^ 

-  2  cos{tketa2)^  RelXmRUMr^  cos{theta4)^  -  2  co5{theta2)^  mRUMd^  ItelY 

-  A  coi{tketa2)^  mRJJi^  +  2  oos{theta2)^  mRUM cos(t/ieta4)^  ItelY 
A-AmRUM sm.{theta2')  r  cos(tketa4)  cos{theta2)  d ItelY 

+  8  mRUM^  sm.(,theta2)  r  coz{theta4)  cos{,theta2)  d^-2  mRUMr^  ItelY 

-  A  mRUM^  cos{theia4)^  +  4  mRZJM^  cos(tAeta2)^  cos(tketa4)^ 

+  8  mRJJl^  cos{theta2)  cos{theta4^  sin(iAefc2)  d 

-  A  mRUM^  d^  cos(theta2)^  -  A  mRZJM^  P"  cos{theta4)^ 

+  A}nRUM^  d"^  cos{theta2')^ 
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Mc2l 2  mRUM r  sm.{theta4)  cos(tketa2)  (-2  mBJJMr^  cos(theta4)  sm(theta2) 

-  2  mRUMr  ^{tketa2')  cos(tketa4)  +  2  mRUMr^  d  zos{theta2) 

+  d  cos{theta2)  ItelX+  2  mRUM coz{theta2)  d^)l{-cos{theta2)'^  ItelXMY 

-  2  cos{theta2)^  ItelXmRUMd^  -  2  cos{tketa2)^  ItelXmRUMr^  oo%{theta4)^ 

-  2  zos{theta2)^  mKUMiP'  ItelY-  A  C0s{theta2)^  mRVhP-  / 

+  2  C0s{theta2')^  mRUMr^  cos(tketa4)^  ItelY 
+  4  mRUM ^{theta2)  r  cos(tketa4)  cos(tketa2)  d  ItelY 

+  8  mRUM^  sml^theta2)r  cos(iAeia4)  cos{theta2')  d^  —  2  mRUMr^  ItelY 

-  4  mRUM^  cos(theta4)^  +  4  mRUM^  zos{theta2)^  cos(theta4)^ 

+  8  mRUM^  C0s(tketa2)  cos(^tketa4)  sm(theta2)  d 

-  A  mRUM^  d^  zoi{tketa2)^  -  A  mRUl^  d^  cos(tketa4)^ 

+  4  mRUM^  coz{theta2')'^  cos{theta4)^ 


